mirror of
https://github.com/Zeal-Operating-System/ZealOS.git
synced 2024-12-28 08:16:31 +00:00
c529b6d7ca
Remove CATARep, ATARep, ATARepEntry, ATARepFind, ATARepExitAllApplications, and ATAIDDrives.
1275 lines
140 KiB
HTML
Executable file
1275 lines
140 KiB
HTML
Executable file
<!DOCTYPE HTML>
|
|
<html>
|
|
<head>
|
|
<meta http-equiv="Content-Type" content="text/html;charset=US-ASCII">
|
|
<meta name="generator" content="ZealOS V0.13">
|
|
<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;}
|
|
</style>
|
|
</head>
|
|
<body>
|
|
<pre style="font-family:monospace;font-size:12pt">
|
|
<a name="l1"></a><span class=cF2>/*</span><span class=cF0>
|
|
<a name="l2"></a></span><span class=cF2>- Perhaps make more references to spec in comments</span><span class=cF0>
|
|
<a name="l3"></a>
|
|
<a name="l4"></a></span><span class=cF2>- ATAPI RW</span><span class=cF0>
|
|
<a name="l5"></a>
|
|
<a name="l6"></a></span><span class=cF2>- Remove Buffer alignment check and just do it on every call</span><span class=cF0>
|
|
<a name="l7"></a>
|
|
<a name="l8"></a></span><span class=cF2>- AHCIATAPISetMaxSpeed?</span><span class=cF0>
|
|
<a name="l9"></a></span><span class=cF2>*/</span><span class=cF0>
|
|
<a name="l10"></a>
|
|
<a name="l11"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cFD>AHCI_DEBUG</span><span class=cF0> = </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l12"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cF5>AHCIDebugMode</span><span class=cF0>(</span><span class=cF1>Bool</span><span class=cF0> mode=</span><span class=cF3>ON</span><span class=cF0>)
|
|
<a name="l13"></a>{
|
|
<a name="l14"></a> </span><span class=cFD>AHCI_DEBUG</span><span class=cF0> = mode;
|
|
<a name="l15"></a>}
|
|
<a name="l16"></a>
|
|
<a name="l17"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cF5>AHCIDebug</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num)
|
|
<a name="l18"></a>{
|
|
<a name="l19"></a> </span><span class=cF9>CAHCIHba</span><span class=cF0> *hba = </span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba;
|
|
<a name="l20"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = &hba->ports[port_num];
|
|
<a name="l21"></a>
|
|
<a name="l22"></a> </span><span class=cF6>"\n"</span><span class=cF0>;
|
|
<a name="l23"></a> </span><span class=cF5>CallerRep</span><span class=cF0>;
|
|
<a name="l24"></a>
|
|
<a name="l25"></a> </span><span class=cF6>"\nAHCI Port: %d"</span><span class=cF0>, port_num;
|
|
<a name="l26"></a>
|
|
<a name="l27"></a> </span><span class=cF6>"\nPort Interrupt Status: %b"</span><span class=cF0>, port->interrupt_status;
|
|
<a name="l28"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_CPDS</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l29"></a> </span><span class=cF6>"\n\tCold Port Detect Status"</span><span class=cF0>;
|
|
<a name="l30"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_TFE</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l31"></a> </span><span class=cF6>"\n\tTask File Error"</span><span class=cF0>;
|
|
<a name="l32"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_HBFS</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l33"></a> </span><span class=cF6>"\n\tHost Bus Fatal Error"</span><span class=cF0>;
|
|
<a name="l34"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_HBDS</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l35"></a> </span><span class=cF6>"\n\tHost Bus Data Error"</span><span class=cF0>;
|
|
<a name="l36"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_IFS</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l37"></a> </span><span class=cF6>"\n\tSATA Interface Fatal Error"</span><span class=cF0>;
|
|
<a name="l38"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_INFS</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l39"></a> </span><span class=cF6>"\n\tSATA Interface Non-Fatal Error"</span><span class=cF0>;
|
|
<a name="l40"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_OFS</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l41"></a> </span><span class=cF6>"\n\tOverflow Status (HBA RX bytes > PRDT bytes)"</span><span class=cF0>;
|
|
<a name="l42"></a> </span><span class=cF6>"\nPort Command: %b"</span><span class=cF0>, port->command;
|
|
<a name="l43"></a> </span><span class=cF6>"\nPort Command Issue: %b"</span><span class=cF0>, port->cmd_issue;
|
|
<a name="l44"></a> </span><span class=cF6>"\nPort Task File Data: %b"</span><span class=cF0>, port->task_file_data;
|
|
<a name="l45"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->task_file_data, </span><span class=cF3>AHCI_PxTFDf_STS_ERR</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l46"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l47"></a> </span><span class=cF6>"\n\tTask File Data Error"</span><span class=cF0>;
|
|
<a name="l48"></a> </span><span class=cF6>"\n\tTask File Data Error Register: %b"</span><span class=cF0>, port->task_file_data.u8[</span><span class=cFE>1</span><span class=cF0>];
|
|
<a name="l49"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l50"></a> </span><span class=cF6>"\nPort Interrupt Enable: %b"</span><span class=cF0>, port->interrupt_enable;
|
|
<a name="l51"></a> </span><span class=cF6>"\nPort SATA Status: %b"</span><span class=cF0>, port->sata_status;
|
|
<a name="l52"></a> </span><span class=cF6>"\nPort SATA Ctrl: %b"</span><span class=cF0>, port->sata_ctrl;
|
|
<a name="l53"></a> </span><span class=cF6>"\nPort SATA Error: %b"</span><span class=cF0>, port->sata_error;
|
|
<a name="l54"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_ERR_I</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l55"></a> </span><span class=cF6>"\n\tRecovered Data Integrity Error"</span><span class=cF0>;
|
|
<a name="l56"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_ERR_M</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l57"></a> </span><span class=cF6>"\n\tRecovered Communication Error"</span><span class=cF0>;
|
|
<a name="l58"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_ERR_T</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l59"></a> </span><span class=cF6>"\n\tTransient Data Integrity Error"</span><span class=cF0>;
|
|
<a name="l60"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_ERR_C</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l61"></a> </span><span class=cF6>"\n\tPersistent Communication Error"</span><span class=cF0>;
|
|
<a name="l62"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_ERR_P</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l63"></a> </span><span class=cF6>"\n\tSATA Protocol Error"</span><span class=cF0>;
|
|
<a name="l64"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_ERR_E</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l65"></a> </span><span class=cF6>"\n\tInternal Error"</span><span class=cF0>;
|
|
<a name="l66"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_DIAG_I</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l67"></a> </span><span class=cF6>"\n\tPHY Internal Error"</span><span class=cF0>;
|
|
<a name="l68"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_DIAG_C</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l69"></a> </span><span class=cF6>"\n\tLink Layer CRC Error"</span><span class=cF0>;
|
|
<a name="l70"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_DIAG_H</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l71"></a> </span><span class=cF6>"\n\tHandshake Error"</span><span class=cF0>;
|
|
<a name="l72"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_DIAG_S</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l73"></a> </span><span class=cF6>"\n\tLink Sequence Error"</span><span class=cF0>;
|
|
<a name="l74"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->sata_error, </span><span class=cF3>AHCI_PxSERR_DIAG_T</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l75"></a> </span><span class=cF6>"\n\tTransport State Transition Error"</span><span class=cF0>;
|
|
<a name="l76"></a> </span><span class=cF6>"\nPort SATA Active: %b"</span><span class=cF0>, port->sata_active;
|
|
<a name="l77"></a> </span><span class=cF6>"\nPort SATA Notif: %b"</span><span class=cF0>, port->sata_notif;
|
|
<a name="l78"></a>
|
|
<a name="l79"></a> </span><span class=cF6>"\n"</span><span class=cF0>;
|
|
<a name="l80"></a>
|
|
<a name="l81"></a> </span><span class=cF6>"\nHBA Capabilities: %b"</span><span class=cF0>, hba->caps;
|
|
<a name="l82"></a> </span><span class=cF6>"\nHBA Interrupt Status: %b"</span><span class=cF0>, hba->interrupt_status;
|
|
<a name="l83"></a> </span><span class=cF1>if</span><span class=cF0> (hba->interrupt_status)
|
|
<a name="l84"></a> </span><span class=cF6>"\n\t(Each set bit is a port with pending interrupt)"</span><span class=cF0>;
|
|
<a name="l85"></a> </span><span class=cF6>"\nHBA Ports Implemented: %b"</span><span class=cF0>, hba->ports_implemented;
|
|
<a name="l86"></a> </span><span class=cF6>"\nHBA Version: 0x%0X"</span><span class=cF0>, hba->version;
|
|
<a name="l87"></a> </span><span class=cF6>"\nHBA Ext Capabilities: %b"</span><span class=cF0>, hba->caps_ext;
|
|
<a name="l88"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&hba->caps_ext, </span><span class=cF3>AHCI_CAPSEXTf_BOH</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l89"></a> </span><span class=cF6>"\n\tBIOS/OS Handoff supported."</span><span class=cF0>;
|
|
<a name="l90"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&hba->caps_ext, </span><span class=cF3>AHCI_CAPSEXTf_NVMP</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l91"></a> </span><span class=cF6>"\n\tNVMHCI Supported (Non-Volatile Memory Host Controller Interface)"</span><span class=cF0>;
|
|
<a name="l92"></a> </span><span class=cF6>"\nHBA BIOS/OS Handoff: %b"</span><span class=cF0>, hba->bohc;
|
|
<a name="l93"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&hba->bohc, </span><span class=cF3>AHCI_BOHCf_BOS</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l94"></a> </span><span class=cF6>"\n\tBIOS owns AHCI Controller"</span><span class=cF0>;
|
|
<a name="l95"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&hba->bohc, </span><span class=cF3>AHCI_BOHCf_BB</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l96"></a> </span><span class=cF6>"\n\tBIOS Busy"</span><span class=cF0>;
|
|
<a name="l97"></a>
|
|
<a name="l98"></a> </span><span class=cF6>"\n"</span><span class=cF0>;
|
|
<a name="l99"></a>
|
|
<a name="l100"></a>}
|
|
<a name="l101"></a>
|
|
<a name="l102"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cFD>AHCILBA48CapacityGet</span><span class=cF0>(</span><span class=cF9>U16</span><span class=cF0> *id_record)
|
|
<a name="l103"></a>{</span><span class=cF2>//Get capacity of drive, in LBA blocks.</span><span class=cF0>
|
|
<a name="l104"></a></span><span class=cF2>//Capacity is stored in a U64, so we take the shortcut</span><span class=cF0>
|
|
<a name="l105"></a></span><span class=cF2>//and access the U16-indexed ID record as U64 indexed. Zero-based value.</span><span class=cF0>
|
|
<a name="l106"></a> </span><span class=cF1>return</span><span class=cF0> (id_record)(</span><span class=cF9>U64</span><span class=cF0> *)[</span><span class=cF3>ATA_IDENT_LBA48_CAPACITY</span><span class=cF0> / </span><span class=cFE>4</span><span class=cF0>] - </span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l107"></a>}
|
|
<a name="l108"></a>
|
|
<a name="l109"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num)
|
|
<a name="l110"></a>{</span><span class=cF2>//Get next free command slot in port; if none, throw error.</span><span class=cF0>
|
|
<a name="l111"></a> </span><span class=cF9>I64</span><span class=cF0> i;
|
|
<a name="l112"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num];
|
|
<a name="l113"></a> </span><span class=cF9>U32</span><span class=cF0> slots = port->sata_active | port->cmd_issue;
|
|
<a name="l114"></a>
|
|
<a name="l115"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < </span><span class=cFB>blkdev</span><span class=cF0>.cmd_slot_count; i++)
|
|
<a name="l116"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l117"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cF7>(</span><span class=cF0>slots & </span><span class=cFE>1</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l118"></a> </span><span class=cF1>return</span><span class=cF0> i;
|
|
<a name="l119"></a>
|
|
<a name="l120"></a> slots >>= </span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l121"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l122"></a>
|
|
<a name="l123"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: No empty command slots on port %d!\n"</span><span class=cF0>, port_num);
|
|
<a name="l124"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l125"></a>}
|
|
<a name="l126"></a>
|
|
<a name="l127"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cF5>AHCIPortSignatureGet</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num)
|
|
<a name="l128"></a>{
|
|
<a name="l129"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port;
|
|
<a name="l130"></a>
|
|
<a name="l131"></a> </span><span class=cF1>if</span><span class=cF0> (port_num < </span><span class=cFE>0</span><span class=cF0> || port_num > </span><span class=cF3>AHCI_MAX_PORTS</span><span class=cF0>)
|
|
<a name="l132"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>NULL</span><span class=cF0>;
|
|
<a name="l133"></a>
|
|
<a name="l134"></a> port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num];
|
|
<a name="l135"></a> </span><span class=cF1>return</span><span class=cF0> port->signature;
|
|
<a name="l136"></a>}
|
|
<a name="l137"></a>
|
|
<a name="l138"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIPortIsIdle</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num)
|
|
<a name="l139"></a>{</span><span class=cF2>//Check if the command engine is running on port.</span><span class=cF0>
|
|
<a name="l140"></a> </span><span class=cF1>return</span><span class=cF0> !(</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num].command & </span><span class=cF7>(</span><span class=cF3>AHCI_PxCMDF_ST</span><span class=cF0> | </span><span class=cF3>AHCI_PxCMDF_CR</span><span class=cF0> | </span><span class=cF3>AHCI_PxCMDF_FR</span><span class=cF0> | </span><span class=cF3>AHCI_PxCMDF_FRE</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l141"></a>}
|
|
<a name="l142"></a>
|
|
<a name="l143"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>AHCIPortCmdStop</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num)
|
|
<a name="l144"></a>{</span><span class=cF2>//Stop command engine on port.</span><span class=cF0>
|
|
<a name="l145"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num];
|
|
<a name="l146"></a>
|
|
<a name="l147"></a> </span><span class=cF5>Btr</span><span class=cF0>(&port->command, </span><span class=cF3>AHCI_PxCMDf_ST</span><span class=cF0>);
|
|
<a name="l148"></a> </span><span class=cF5>Btr</span><span class=cF0>(&port->command, </span><span class=cF3>AHCI_PxCMDf_FRE</span><span class=cF0>);
|
|
<a name="l149"></a>
|
|
<a name="l150"></a> </span><span class=cF1>while</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->command, </span><span class=cF3>AHCI_PxCMDf_CR</span><span class=cF7>)</span><span class=cF0> || </span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->command, </span><span class=cF3>AHCI_PxCMDf_FR</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l151"></a>}
|
|
<a name="l152"></a>
|
|
<a name="l153"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>AHCIPortCmdStart</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num)
|
|
<a name="l154"></a>{</span><span class=cF2>//Start command engine on port.</span><span class=cF0>
|
|
<a name="l155"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num];
|
|
<a name="l156"></a>
|
|
<a name="l157"></a> </span><span class=cF1>while</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->command, </span><span class=cF3>AHCI_PxCMDf_CR</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l158"></a>
|
|
<a name="l159"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->command, </span><span class=cF3>AHCI_PxCMDf_FRE</span><span class=cF0>);
|
|
<a name="l160"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->command, </span><span class=cF3>AHCI_PxCMDf_ST</span><span class=cF0>);
|
|
<a name="l161"></a>}
|
|
<a name="l162"></a>
|
|
<a name="l163"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num, </span><span class=cF1>F64</span><span class=cF0> timeout, </span><span class=cF1>Bool</span><span class=cF0> throwing=</span><span class=cF3>TRUE</span><span class=cF0>)
|
|
<a name="l164"></a>{</span><span class=cF2>//Wait until DRQ & BSY are clear in port task file.</span><span class=cF0>
|
|
<a name="l165"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num];
|
|
<a name="l166"></a> </span><span class=cF1>U8</span><span class=cF0> str[</span><span class=cF3>STR_LEN</span><span class=cF0>];
|
|
<a name="l167"></a>
|
|
<a name="l168"></a> </span><span class=cF1>do</span><span class=cF0>
|
|
<a name="l169"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l170"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cF7>(</span><span class=cF0>port->task_file_data & (</span><span class=cF3>ATAS_DRQ</span><span class=cF0> | </span><span class=cF3>ATAS_BSY</span><span class=cF0>)</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l171"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l172"></a> </span><span class=cF5>Yield</span><span class=cF0>; </span><span class=cF2>// don't hang OS</span><span class=cF0>
|
|
<a name="l173"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l174"></a> </span><span class=cF1>while</span><span class=cF0> (timeout > </span><span class=cF5>tS</span><span class=cF0>);
|
|
<a name="l175"></a>
|
|
<a name="l176"></a> </span><span class=cF1>if</span><span class=cF0> (throwing)
|
|
<a name="l177"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l178"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>AHCI_DEBUG</span><span class=cF0>)
|
|
<a name="l179"></a> {
|
|
<a name="l180"></a> </span><span class=cF5>StrPrint</span><span class=cF0>(str, </span><span class=cF6>"Run AHCIDebug(%d);"</span><span class=cF0>, port_num);
|
|
<a name="l181"></a> </span><span class=cF5>Debug</span><span class=cF0>(str);
|
|
<a name="l182"></a> }
|
|
<a name="l183"></a>
|
|
<a name="l184"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Port %d hung.\n"</span><span class=cF0>, port_num);
|
|
<a name="l185"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l186"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l187"></a>
|
|
<a name="l188"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l189"></a>}
|
|
<a name="l190"></a>
|
|
<a name="l191"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cF5>AHCIPortReset</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num)
|
|
<a name="l192"></a>{</span><span class=cF2>//Software reset of port. Port command engine must be started after this.</span><span class=cF0>
|
|
<a name="l193"></a> </span><span class=cF2>//If port is not responsive we do a full reset.</span><span class=cF0>
|
|
<a name="l194"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num];
|
|
<a name="l195"></a>
|
|
<a name="l196"></a> </span><span class=cFD>AHCIPortCmdStop</span><span class=cF0>(port_num);
|
|
<a name="l197"></a>
|
|
<a name="l198"></a> port->interrupt_status = port->interrupt_status; </span><span class=cF2>//Acknowledge all interrupt statuses.</span><span class=cF0>
|
|
<a name="l199"></a>
|
|
<a name="l200"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>AHCIPortWait</span><span class=cF7>(</span><span class=cF0>port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>1</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l201"></a> </span><span class=cF7>{</span><span class=cF2>//Perform 'more intrusive' HBA<->Port comm reset (sec. 10.4.2 of spec).</span><span class=cF0>
|
|
<a name="l202"></a> port->sata_ctrl = </span><span class=cF3>AHCI_PxSCTLF_DET_INIT</span><span class=cF0>;
|
|
<a name="l203"></a> </span><span class=cF5>Sleep</span><span class=cF0>(</span><span class=cFE>2</span><span class=cF0>); </span><span class=cF2>//Spec says 1 millisecond</span><span class=cF0>
|
|
<a name="l204"></a> port->sata_ctrl = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l205"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l206"></a>
|
|
<a name="l207"></a> </span><span class=cF1>while</span><span class=cF0> (port->sata_status & </span><span class=cFE>0xF</span><span class=cF0> != </span><span class=cF3>AHCI_PxSSTSF_DET_PRESENT</span><span class=cF0>);
|
|
<a name="l208"></a>
|
|
<a name="l209"></a> port->sata_error = ~</span><span class=cFE>0</span><span class=cF0>; </span><span class=cF2>//Write all 1s to sata error register.</span><span class=cF0>
|
|
<a name="l210"></a>}
|
|
<a name="l211"></a>
|
|
<a name="l212"></a></span><span class=cF9>CPortCmdHeader</span><span class=cF0> *</span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num, </span><span class=cF9>I64</span><span class=cF0> cmd_slot)
|
|
<a name="l213"></a>{</span><span class=cF2>//Get current command slot header on port.</span><span class=cF0>
|
|
<a name="l214"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num];
|
|
<a name="l215"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = port->cmd_list_base;
|
|
<a name="l216"></a>
|
|
<a name="l217"></a> </span><span class=cF1>return</span><span class=cF0> cmd_header + cmd_slot; </span><span class=cF2>//Move up pointer to the slot we have in the command list.</span><span class=cF0>
|
|
<a name="l218"></a>}
|
|
<a name="l219"></a>
|
|
<a name="l220"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(</span><span class=cF9>I64</span><span class=cF0> port_num, </span><span class=cF9>I64</span><span class=cF0> cmd_slot)
|
|
<a name="l221"></a>{</span><span class=cF2>//Wait on command completion after command issue, and double check any error.</span><span class=cF0>
|
|
<a name="l222"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[port_num];
|
|
<a name="l223"></a> </span><span class=cF1>U8</span><span class=cF0> str[</span><span class=cF3>STR_LEN</span><span class=cF0>];
|
|
<a name="l224"></a>
|
|
<a name="l225"></a> </span><span class=cF1>while</span><span class=cF0> (</span><span class=cF3>TRUE</span><span class=cF0>)
|
|
<a name="l226"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l227"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->cmd_issue, cmd_slot</span><span class=cF7>)</span><span class=cF0>) </span><span class=cF2>//When command has been processed</span><span class=cF0>
|
|
<a name="l228"></a> </span><span class=cF1>break</span><span class=cF0>;
|
|
<a name="l229"></a>
|
|
<a name="l230"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_TFE</span><span class=cF7>)</span><span class=cF0>) </span><span class=cF2>//Task File Error (</span><a href="https://zeal-operating-system.github.io/ZealOS/Kernel/KernelA.HH.html#l2959"><span class=cF4>ATAS_ERR</span></a><span class=cF2>)</span><span class=cF0>
|
|
<a name="l231"></a> {
|
|
<a name="l232"></a>error:
|
|
<a name="l233"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cFD>AHCI_DEBUG</span><span class=cF0>)
|
|
<a name="l234"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l235"></a> </span><span class=cF5>StrPrint</span><span class=cF0>(str, </span><span class=cF6>"Run AHCIDebug(%d);"</span><span class=cF0>, port_num);
|
|
<a name="l236"></a> </span><span class=cF5>Debug</span><span class=cF0>(str);
|
|
<a name="l237"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l238"></a>
|
|
<a name="l239"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Port %d: Command failed!\n"</span><span class=cF0>, port_num);
|
|
<a name="l240"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l241"></a> }
|
|
<a name="l242"></a>
|
|
<a name="l243"></a> </span><span class=cF5>Yield</span><span class=cF0>; </span><span class=cF2>// don't hang OS</span><span class=cF0>
|
|
<a name="l244"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l245"></a>
|
|
<a name="l246"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&port->interrupt_status, </span><span class=cF3>AHCI_PxIf_TFE</span><span class=cF7>)</span><span class=cF0>) </span><span class=cF2>//Second safety check</span><span class=cF0>
|
|
<a name="l247"></a> </span><span class=cF1>goto</span><span class=cF0> error;
|
|
<a name="l248"></a>}
|
|
<a name="l249"></a>
|
|
<a name="l250"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cFD>AHCIAtapiCapacityGet</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd)
|
|
<a name="l251"></a>{
|
|
<a name="l252"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l253"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l254"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l255"></a> </span><span class=cF9>I64</span><span class=cF0> cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l256"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l257"></a> </span><span class=cF9>U32</span><span class=cF0> *buf;
|
|
<a name="l258"></a>
|
|
<a name="l259"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l260"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l261"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATAPI drive!\n"</span><span class=cF0>);
|
|
<a name="l262"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l263"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l264"></a>
|
|
<a name="l265"></a> buf = </span><span class=cF5>CAlloc</span><span class=cF0>(</span><span class=cFE>8</span><span class=cF0>, </span><span class=cFB>sys_task</span><span class=cF0>->code_heap);
|
|
<a name="l266"></a>
|
|
<a name="l267"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_A</span><span class=cF0>);
|
|
<a name="l268"></a>
|
|
<a name="l269"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l270"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l271"></a>
|
|
<a name="l272"></a> </span><span class=cF2>//Set up single PRD</span><span class=cF0>
|
|
<a name="l273"></a> cmd_table->prdt[</span><span class=cFE>0</span><span class=cF0>].data_base = buf;
|
|
<a name="l274"></a> cmd_table->prdt[</span><span class=cFE>0</span><span class=cF0>].data_byte_count = </span><span class=cF3>DVD_BLK_SIZE</span><span class=cF0> - </span><span class=cFE>1</span><span class=cF0>; </span><span class=cF2>//Zero-based value</span><span class=cF0>
|
|
<a name="l275"></a> cmd_header->prdt_len = </span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l276"></a>
|
|
<a name="l277"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l278"></a>
|
|
<a name="l279"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l280"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS.</span><span class=cF0>
|
|
<a name="l281"></a> cmd_fis->command = </span><span class=cF3>ATA_PACKET</span><span class=cF0>;
|
|
<a name="l282"></a> cmd_table->acmd[</span><span class=cFE>0</span><span class=cF0>] = </span><span class=cF3>ATAPI_READ_CAPACITY</span><span class=cF0> >> </span><span class=cFE>8</span><span class=cF0>;
|
|
<a name="l283"></a>
|
|
<a name="l284"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l285"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot); </span><span class=cF2>//Issue the command.</span><span class=cF0>
|
|
<a name="l286"></a>
|
|
<a name="l287"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l288"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l289"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l290"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l291"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l292"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l293"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l294"></a>
|
|
<a name="l295"></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>]);
|
|
<a name="l296"></a>}
|
|
<a name="l297"></a>
|
|
<a name="l298"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF5>AHCIAtapiSeek</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="l299"></a>{
|
|
<a name="l300"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l301"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l302"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l303"></a> </span><span class=cF9>I64</span><span class=cF0> cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l304"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l305"></a>
|
|
<a name="l306"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l307"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l308"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATAPI drive!\n"</span><span class=cF0>);
|
|
<a name="l309"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l310"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l311"></a>
|
|
<a name="l312"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_A</span><span class=cF0>);
|
|
<a name="l313"></a>
|
|
<a name="l314"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l315"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l316"></a>
|
|
<a name="l317"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l318"></a>
|
|
<a name="l319"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l320"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS.</span><span class=cF0>
|
|
<a name="l321"></a> cmd_fis->command = </span><span class=cF3>ATA_PACKET</span><span class=cF0>;
|
|
<a name="l322"></a> cmd_table->acmd[</span><span class=cFE>0</span><span class=cF0>] = </span><span class=cF3>ATAPI_SEEK</span><span class=cF0> >> </span><span class=cFE>8</span><span class=cF0>;
|
|
<a name="l323"></a> cmd_table->acmd[</span><span class=cFE>2</span><span class=cF0>] = blk.u8[</span><span class=cFE>3</span><span class=cF0>];
|
|
<a name="l324"></a> cmd_table->acmd[</span><span class=cFE>3</span><span class=cF0>] = blk.u8[</span><span class=cFE>2</span><span class=cF0>];
|
|
<a name="l325"></a> cmd_table->acmd[</span><span class=cFE>4</span><span class=cF0>] = blk.u8[</span><span class=cFE>1</span><span class=cF0>];
|
|
<a name="l326"></a> cmd_table->acmd[</span><span class=cFE>5</span><span class=cF0>] = blk.u8[</span><span class=cFE>0</span><span class=cF0>];
|
|
<a name="l327"></a>
|
|
<a name="l328"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l329"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot); </span><span class=cF2>//Issue the command.</span><span class=cF0>
|
|
<a name="l330"></a>
|
|
<a name="l331"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l332"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l333"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l334"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l335"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l336"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l337"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l338"></a>
|
|
<a name="l339"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l340"></a>}
|
|
<a name="l341"></a>
|
|
<a name="l342"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIAtapiSync</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd)
|
|
<a name="l343"></a>{</span><span class=cF2>//untested</span><span class=cF0>
|
|
<a name="l344"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l345"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l346"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l347"></a> </span><span class=cF9>I64</span><span class=cF0> cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l348"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l349"></a>
|
|
<a name="l350"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l351"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l352"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATAPI drive!\n"</span><span class=cF0>);
|
|
<a name="l353"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l354"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l355"></a>
|
|
<a name="l356"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_A</span><span class=cF0>);
|
|
<a name="l357"></a>
|
|
<a name="l358"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l359"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l360"></a>
|
|
<a name="l361"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l362"></a>
|
|
<a name="l363"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l364"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS.</span><span class=cF0>
|
|
<a name="l365"></a> cmd_fis->command = </span><span class=cF3>ATA_PACKET</span><span class=cF0>;
|
|
<a name="l366"></a> cmd_table->acmd[</span><span class=cFE>0</span><span class=cF0>] = </span><span class=cF3>ATAPI_SYNC_CACHE</span><span class=cF0> >> </span><span class=cFE>8</span><span class=cF0>;
|
|
<a name="l367"></a>
|
|
<a name="l368"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l369"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot); </span><span class=cF2>//Issue the command.</span><span class=cF0>
|
|
<a name="l370"></a>
|
|
<a name="l371"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l372"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l373"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l374"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l375"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l376"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l377"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l378"></a>
|
|
<a name="l379"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l380"></a>}
|
|
<a name="l381"></a>
|
|
<a name="l382"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIAtapiClose</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="l383"></a>{</span><span class=cF2>//untested</span><span class=cF0>
|
|
<a name="l384"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l385"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l386"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l387"></a> </span><span class=cF9>I64</span><span class=cF0> cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l388"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l389"></a>
|
|
<a name="l390"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l391"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l392"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATAPI drive!\n"</span><span class=cF0>);
|
|
<a name="l393"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l394"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l395"></a>
|
|
<a name="l396"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_A</span><span class=cF0>);
|
|
<a name="l397"></a>
|
|
<a name="l398"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l399"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l400"></a>
|
|
<a name="l401"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l402"></a>
|
|
<a name="l403"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l404"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS.</span><span class=cF0>
|
|
<a name="l405"></a> cmd_fis->command = </span><span class=cF3>ATA_PACKET</span><span class=cF0>;
|
|
<a name="l406"></a> cmd_table->acmd[</span><span class=cFE>0</span><span class=cF0>] = </span><span class=cF3>ATAPI_CLOSE_TRACK_SESSION</span><span class=cF0> >> </span><span class=cFE>8</span><span class=cF0>;
|
|
<a name="l407"></a> cmd_table->acmd[</span><span class=cFE>2</span><span class=cF0>] = close_field.u8[</span><span class=cFE>1</span><span class=cF0>];
|
|
<a name="l408"></a> cmd_table->acmd[</span><span class=cFE>4</span><span class=cF0>] = track.u8[</span><span class=cFE>1</span><span class=cF0>];
|
|
<a name="l409"></a> cmd_table->acmd[</span><span class=cFE>5</span><span class=cF0>] = track.u8[</span><span class=cFE>0</span><span class=cF0>];
|
|
<a name="l410"></a>
|
|
<a name="l411"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l412"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot); </span><span class=cF2>//Issue the command.</span><span class=cF0>
|
|
<a name="l413"></a>
|
|
<a name="l414"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l415"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l416"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l417"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l418"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l419"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l420"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l421"></a>
|
|
<a name="l422"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l423"></a>}
|
|
<a name="l424"></a>
|
|
<a name="l425"></a></span><span class=cF2>//TODO #define some bits/constants</span><span class=cF0>
|
|
<a name="l426"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIAtapiFormat</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF9>I64</span><span class=cF0> count)
|
|
<a name="l427"></a>{ </span><span class=cF2>// untested</span><span class=cF0>
|
|
<a name="l428"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l429"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l430"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l431"></a> </span><span class=cF9>I64</span><span class=cF0> cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l432"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l433"></a> </span><span class=cF9>CAtapiFormatCmd</span><span class=cF0> format_cmd;
|
|
<a name="l434"></a> </span><span class=cF9>CAtapiFormatParamList</span><span class=cF0> *format_list;
|
|
<a name="l435"></a>
|
|
<a name="l436"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l437"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l438"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATAPI drive!\n"</span><span class=cF0>);
|
|
<a name="l439"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l440"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l441"></a>
|
|
<a name="l442"></a> format_list = </span><span class=cF5>CAlloc</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CAtapiFormatParamList</span><span class=cF7>)</span><span class=cF0>, </span><span class=cFB>sys_task</span><span class=cF0>->code_heap);
|
|
<a name="l443"></a> format_list->length = </span><span class=cF5>EndianU16</span><span class=cF0>(</span><span class=cFE>8</span><span class=cF0>);
|
|
<a name="l444"></a> format_list->num_blocks = </span><span class=cF5>EndianU32</span><span class=cF0>(count</span><span class=cF7>(</span><span class=cF9>U32</span><span class=cF7>)</span><span class=cF0>); </span><span class=cF2>// remove this safety-cast if not needed</span><span class=cF0>
|
|
<a name="l445"></a> format_list->extra[</span><span class=cFE>1</span><span class=cF0>] = </span><span class=cFE>0x80</span><span class=cF0>;
|
|
<a name="l446"></a>
|
|
<a name="l447"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_A</span><span class=cF0>);
|
|
<a name="l448"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>Bts(&cmd_header->desc, AHCI_CH_DESCf_W); // do we need to set Write ?</span><span class=cF0>
|
|
<a name="l449"></a>
|
|
<a name="l450"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l451"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l452"></a>
|
|
<a name="l453"></a> cmd_table->prdt[</span><span class=cFE>0</span><span class=cF0>].data_base = format_list;
|
|
<a name="l454"></a> cmd_table->prdt[</span><span class=cFE>0</span><span class=cF0>].data_byte_count = </span><span class=cFE>12</span><span class=cF0> - </span><span class=cFE>1</span><span class=cF0>; </span><span class=cF2>// zero based, size of format parameter list</span><span class=cF0>
|
|
<a name="l455"></a> cmd_header->prdt_len = </span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l456"></a>
|
|
<a name="l457"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l458"></a>
|
|
<a name="l459"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l460"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>cmd_fis->feature_low= 0x23; // Formattable?...</span><span class=cF0>
|
|
<a name="l461"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS.</span><span class=cF0>
|
|
<a name="l462"></a> cmd_fis->command = </span><span class=cF3>ATA_PACKET</span><span class=cF0>;
|
|
<a name="l463"></a>
|
|
<a name="l464"></a> </span><span class=cF5>MemSet</span><span class=cF0>(&format_cmd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CAtapiFormatCmd</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l465"></a> format_cmd.command = </span><span class=cF3>ATAPI_FORMAT_UNIT</span><span class=cF0> >> </span><span class=cFE>8</span><span class=cF0>; </span><span class=cF2>//FIX</span><span class=cF0>
|
|
<a name="l466"></a> format_cmd.code = </span><span class=cFE>1</span><span class=cF0> | </span><span class=cFE>1</span><span class=cF0> << </span><span class=cFE>4</span><span class=cF0>; </span><span class=cF2>// TODO !!! FORMAT UNIT CODE FLAGS (1 mandatory, 1<<4 mandatory for MM drives)</span><span class=cF0>
|
|
<a name="l467"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(&cmd_table->acmd, &format_cmd, </span><span class=cFE>6</span><span class=cF0>); </span><span class=cF2>// ?</span><span class=cF0>
|
|
<a name="l468"></a>
|
|
<a name="l469"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l470"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot); </span><span class=cF2>//Issue the command.</span><span class=cF0>
|
|
<a name="l471"></a>
|
|
<a name="l472"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l473"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l474"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l475"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l476"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l477"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l478"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l479"></a>
|
|
<a name="l480"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l481"></a>}
|
|
<a name="l482"></a>
|
|
<a name="l483"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF5>AHCIAtapiStartStop</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF1>start</span><span class=cF0>)
|
|
<a name="l484"></a>{
|
|
<a name="l485"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l486"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l487"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l488"></a> </span><span class=cF9>I64</span><span class=cF0> cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l489"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l490"></a>
|
|
<a name="l491"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l492"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l493"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATAPI drive!\n"</span><span class=cF0>);
|
|
<a name="l494"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l495"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l496"></a>
|
|
<a name="l497"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_A</span><span class=cF0>);
|
|
<a name="l498"></a>
|
|
<a name="l499"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l500"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l501"></a>
|
|
<a name="l502"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l503"></a>
|
|
<a name="l504"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l505"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS.</span><span class=cF0>
|
|
<a name="l506"></a> cmd_fis->command = </span><span class=cF3>ATA_PACKET</span><span class=cF0>;
|
|
<a name="l507"></a> cmd_table->acmd[</span><span class=cFE>0</span><span class=cF0>] = </span><span class=cF3>ATAPI_START_STOP_UNIT</span><span class=cF0> >> </span><span class=cFE>8</span><span class=cF0>;
|
|
<a name="l508"></a> cmd_table->acmd[</span><span class=cFE>4</span><span class=cF0>] = </span><span class=cF1>start</span><span class=cF0>;
|
|
<a name="l509"></a>
|
|
<a name="l510"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l511"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot); </span><span class=cF2>//Issue the command.</span><span class=cF0>
|
|
<a name="l512"></a>
|
|
<a name="l513"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l514"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l515"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l516"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l517"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l518"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l519"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l520"></a>
|
|
<a name="l521"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l522"></a>}
|
|
<a name="l523"></a>
|
|
<a name="l524"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF5>DiscEject</span><span class=cF0>(</span><span class=cF1>U8</span><span class=cF0> drv_let)
|
|
<a name="l525"></a>{ </span><span class=cF2>// returns whether disc tray was successfully ejected.</span><span class=cF0>
|
|
<a name="l526"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l527"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF5>AHCIAtapiStartStop</span><span class=cF0>(</span><span class=cF5>Letter2BlkDev</span><span class=cF7>(</span><span class=cF0>drv_let</span><span class=cF7>)</span><span class=cF0>, </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l528"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l529"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l530"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l531"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l532"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l533"></a>}
|
|
<a name="l534"></a>
|
|
<a name="l535"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF5>DiscLoad</span><span class=cF0>(</span><span class=cF1>U8</span><span class=cF0> drv_let)
|
|
<a name="l536"></a>{ </span><span class=cF2>// returns whether disc tray was successfully closed & disc loaded.</span><span class=cF0>
|
|
<a name="l537"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l538"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF5>AHCIAtapiStartStop</span><span class=cF0>(</span><span class=cF5>Letter2BlkDev</span><span class=cF7>(</span><span class=cF0>drv_let</span><span class=cF7>)</span><span class=cF0>, </span><span class=cFE>3</span><span class=cF0>);
|
|
<a name="l539"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l540"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l541"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l542"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l543"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l544"></a>}
|
|
<a name="l545"></a>
|
|
<a name="l546"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>AHCIPortIdentify</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd)
|
|
<a name="l547"></a>{</span><span class=cF2>//Perform ATA_IDENTIFY command on ATA/ATAPI drive and store capacity and id record.</span><span class=cF0>
|
|
<a name="l548"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l549"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l550"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l551"></a> </span><span class=cF9>I64</span><span class=cF0> cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l552"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l553"></a> </span><span class=cF9>U16</span><span class=cF0> *dev_id_record;
|
|
<a name="l554"></a>
|
|
<a name="l555"></a> port->interrupt_status = port->interrupt_status; </span><span class=cF2>//TODO: Why?</span><span class=cF0>
|
|
<a name="l556"></a>
|
|
<a name="l557"></a> </span><span class=cF2>//Using the code heap for this alloc to stay under 32-bit address space.</span><span class=cF0>
|
|
<a name="l558"></a> dev_id_record = </span><span class=cF5>CAlloc</span><span class=cF0>(</span><span class=cFE>512</span><span class=cF0>, </span><span class=cFB>sys_task</span><span class=cF0>->code_heap);
|
|
<a name="l559"></a>
|
|
<a name="l560"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l561"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l562"></a>
|
|
<a name="l563"></a> </span><span class=cF2>//Set up single PRD</span><span class=cF0>
|
|
<a name="l564"></a> cmd_table->prdt[</span><span class=cFE>0</span><span class=cF0>].data_base = dev_id_record;
|
|
<a name="l565"></a> cmd_table->prdt[</span><span class=cFE>0</span><span class=cF0>].data_base_upper = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l566"></a> cmd_table->prdt[</span><span class=cFE>0</span><span class=cF0>].data_byte_count = </span><span class=cFE>512</span><span class=cF0> - </span><span class=cFE>1</span><span class=cF0>; </span><span class=cF2>//Zero-based value</span><span class=cF0>
|
|
<a name="l567"></a> cmd_header->prdt_len = </span><span class=cFE>1</span><span class=cF0>; </span><span class=cF2>//1 PRD, as described above, which contains the address to put the ID record.</span><span class=cF0>
|
|
<a name="l568"></a>
|
|
<a name="l569"></a> </span><span class=cF2>//Setup command FIS</span><span class=cF0>
|
|
<a name="l570"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l571"></a>
|
|
<a name="l572"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l573"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS.</span><span class=cF0>
|
|
<a name="l574"></a>
|
|
<a name="l575"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature == </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l576"></a> cmd_fis->command = </span><span class=cF3>ATA_IDENTIFY_PACKET</span><span class=cF0>;
|
|
<a name="l577"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l578"></a> cmd_fis->command = </span><span class=cF3>ATA_IDENTIFY</span><span class=cF0>;
|
|
<a name="l579"></a>
|
|
<a name="l580"></a> cmd_fis->device = </span><span class=cFE>0</span><span class=cF0>; </span><span class=cF2>//No bits need to be set in the device register.</span><span class=cF0>
|
|
<a name="l581"></a>
|
|
<a name="l582"></a> </span><span class=cF2>//Wait on previous command to complete.</span><span class=cF0>
|
|
<a name="l583"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l584"></a>
|
|
<a name="l585"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot); </span><span class=cF2>//Issue the command.</span><span class=cF0>
|
|
<a name="l586"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l587"></a>
|
|
<a name="l588"></a> </span><span class=cF5>Free</span><span class=cF0>(bd->dev_id_record);
|
|
<a name="l589"></a> bd->dev_id_record = dev_id_record;
|
|
<a name="l590"></a>
|
|
<a name="l591"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature == </span><span class=cF3>AHCI_PxSIG_ATA</span><span class=cF0>)
|
|
<a name="l592"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l593"></a> bd->max_blk = </span><span class=cFD>AHCILBA48CapacityGet</span><span class=cF0>(dev_id_record);
|
|
<a name="l594"></a> </span><span class=cF6>"MAX BLOCK %d, disk size %d MiB\n"</span><span class=cF0>, bd->max_blk, bd->max_blk * </span><span class=cF3>BLK_SIZE</span><span class=cF0> / </span><span class=cFE>1024</span><span class=cF0> / </span><span class=cFE>1024</span><span class=cF0>;
|
|
<a name="l595"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l596"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l597"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l598"></a> bd->max_blk = </span><span class=cFD>AHCIAtapiCapacityGet</span><span class=cF0>(bd);
|
|
<a name="l599"></a> </span><span class=cF6>"MAX BLOCK %d, disk size %d MiB\n"</span><span class=cF0>, bd->max_blk, bd->max_blk * </span><span class=cF3>DVD_BLK_SIZE</span><span class=cF0> / </span><span class=cFE>1024</span><span class=cF0> / </span><span class=cFE>1024</span><span class=cF0>;
|
|
<a name="l600"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l601"></a>}
|
|
<a name="l602"></a>
|
|
<a name="l603"></a></span><span class=cF1>U8</span><span class=cF0> *</span><span class=cFD>AHCIBufferAlign</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF1>U8</span><span class=cF0> *user_buf, </span><span class=cF9>I64</span><span class=cF0> buf_size, </span><span class=cF1>Bool</span><span class=cF0> write)
|
|
<a name="l604"></a>{</span><span class=cF2>//Make sure buffer is accessible by HBA controller.</span><span class=cF0>
|
|
<a name="l605"></a></span><span class=cF2>//Controller requires a U16 aligned buffer and in 32-bit address space (We are not using 64-bit capabilities).</span><span class=cF0>
|
|
<a name="l606"></a></span><span class=cF2>//MAlloc provides U64-aligned addresses, and can allocate in the code heap ( <4GB ).</span><span class=cF0>
|
|
<a name="l607"></a></span><span class=cF2>//In the case of an inadequate buffer address being passed in, we will use a MAlloced internal buffer.</span><span class=cF0>
|
|
<a name="l608"></a> </span><span class=cF1>if</span><span class=cF0>(user_buf + buf_size > </span><span class=cF3>U32_MAX</span><span class=cF0> || user_buf & </span><span class=cFE>1</span><span class=cF0>)
|
|
<a name="l609"></a> </span><span class=cF7>{</span><span class=cF2>//if the buffer is not within 32-bit address space or not U16-aligned</span><span class=cF0>
|
|
<a name="l610"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Aligning buffer under 32-bit range\n";</span><span class=cF0>
|
|
<a name="l611"></a>
|
|
<a name="l612"></a> </span><span class=cF5>Free</span><span class=cF0>(bd->prd_buf);
|
|
<a name="l613"></a> bd->prd_buf = </span><span class=cF5>MAlloc</span><span class=cF0>(buf_size, </span><span class=cFB>sys_task</span><span class=cF0>->code_heap);
|
|
<a name="l614"></a>
|
|
<a name="l615"></a> </span><span class=cF5>Bts</span><span class=cF0>(&bd->flags, </span><span class=cF3>BDf_INTERNAL_BUF</span><span class=cF0>);
|
|
<a name="l616"></a>
|
|
<a name="l617"></a> </span><span class=cF1>if</span><span class=cF0> (write)
|
|
<a name="l618"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(bd->prd_buf, user_buf, buf_size);
|
|
<a name="l619"></a>
|
|
<a name="l620"></a> </span><span class=cF1>return</span><span class=cF0> bd->prd_buf;
|
|
<a name="l621"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l622"></a> </span><span class=cF5>Btr</span><span class=cF0>(&bd->flags, </span><span class=cF3>BDF_INTERNAL_BUF</span><span class=cF0>);
|
|
<a name="l623"></a>
|
|
<a name="l624"></a> </span><span class=cF1>return</span><span class=cF0> user_buf;
|
|
<a name="l625"></a>}
|
|
<a name="l626"></a>
|
|
<a name="l627"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cF5>AHCIAtaBlksRW</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> blk, </span><span class=cF9>I64</span><span class=cF0> count, </span><span class=cF1>Bool</span><span class=cF0> write)
|
|
<a name="l628"></a>{</span><span class=cF2>//Read/Write ATA disk blocks. Returns number of bytes transferred between system and disk.</span><span class=cF0>
|
|
<a name="l629"></a></span><span class=cF2>//Don't use this, use the AHCIAtaBlksRead and AHCIAtaBlksWrite functions.</span><span class=cF0>
|
|
<a name="l630"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l631"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l632"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l633"></a> </span><span class=cF9>I64</span><span class=cF0> i, buf_size, buf_size_tmp, byte_count, prdt_len, cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l634"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l635"></a> </span><span class=cF1>U8</span><span class=cF0> *internal_buf_tmp, *internal_buf;
|
|
<a name="l636"></a> </span><span class=cF1>Bool</span><span class=cF0> unlock;
|
|
<a name="l637"></a>
|
|
<a name="l638"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATA</span><span class=cF0>)
|
|
<a name="l639"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l640"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATA drive!\n"</span><span class=cF0>);
|
|
<a name="l641"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l642"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l643"></a>
|
|
<a name="l644"></a> </span><span class=cF1>if</span><span class=cF0> (count < </span><span class=cFE>1</span><span class=cF0>) </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l645"></a> </span><span class=cF1>if</span><span class=cF0> (count > </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>)
|
|
<a name="l646"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l647"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Block count %d max allowed in one command (%d)"</span><span class=cF0>, count, </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>);
|
|
<a name="l648"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l649"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l650"></a>
|
|
<a name="l651"></a> unlock = </span><span class=cF5>BlkDevLock</span><span class=cF0>(bd);
|
|
<a name="l652"></a>
|
|
<a name="l653"></a> </span><span class=cF2>//Determine buffer size and PRDT length.</span><span class=cF0>
|
|
<a name="l654"></a> buf_size = buf_size_tmp = count * </span><span class=cF3>BLK_SIZE</span><span class=cF0>;
|
|
<a name="l655"></a> prdt_len = (buf_size - </span><span class=cFE>1</span><span class=cF0>) / </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0> + </span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l656"></a>
|
|
<a name="l657"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"PRDT Length:\t%d\n", prdt_len;</span><span class=cF0>
|
|
<a name="l658"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Count:\t\t\t%d\n", count;</span><span class=cF0>
|
|
<a name="l659"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Buffer size:\t%X\n", buf_size;</span><span class=cF0>
|
|
<a name="l660"></a>
|
|
<a name="l661"></a> cmd_header->prdt_len = prdt_len; </span><span class=cF2>//Set PRD table length in cmd header.</span><span class=cF0>
|
|
<a name="l662"></a> </span><span class=cF2>//Set 'write' bit depending on 'write' argument.</span><span class=cF0>
|
|
<a name="l663"></a> </span><span class=cF5>BEqual</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_W</span><span class=cF0>, write);
|
|
<a name="l664"></a>
|
|
<a name="l665"></a> internal_buf = internal_buf_tmp = </span><span class=cFD>AHCIBufferAlign</span><span class=cF0>(bd, buf, buf_size, write);
|
|
<a name="l666"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Buffer:\t\t\t0x%X\n", internal_buf;</span><span class=cF0>
|
|
<a name="l667"></a>
|
|
<a name="l668"></a> </span><span class=cF1>if</span><span class=cF0> (!internal_buf) </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>); </span><span class=cF2>//Will probably never happen.</span><span class=cF0>
|
|
<a name="l669"></a>
|
|
<a name="l670"></a> </span><span class=cF2>//Obtain command table and zero it. This contains the command FIS and the PRDT.</span><span class=cF0>
|
|
<a name="l671"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l672"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l673"></a>
|
|
<a name="l674"></a> </span><span class=cF2>//Create 'prdt_len' amount of PRD entries in the command table</span><span class=cF0>
|
|
<a name="l675"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < prdt_len; i++)
|
|
<a name="l676"></a> </span><span class=cF7>{</span><span class=cF2>//Use max PRD size until the remaining buffer is smaller than max size.</span><span class=cF0>
|
|
<a name="l677"></a> </span><span class=cF1>if</span><span class=cF0> (buf_size_tmp > </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0>)
|
|
<a name="l678"></a> byte_count = </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0>;
|
|
<a name="l679"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l680"></a> byte_count = buf_size_tmp;
|
|
<a name="l681"></a>
|
|
<a name="l682"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"prdt[%d].data_base_addr = 0x%X\n" , i, internal_buf_tmp;</span><span class=cF0>
|
|
<a name="l683"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"prdt[%d].data_byte_count = 0x%X\n\n", i, byte_count;</span><span class=cF0>
|
|
<a name="l684"></a>
|
|
<a name="l685"></a> cmd_table->prdt[i].data_base = internal_buf_tmp;
|
|
<a name="l686"></a> cmd_table->prdt[i].data_byte_count = byte_count - </span><span class=cFE>1</span><span class=cF0>; </span><span class=cF2>//Zero-based value</span><span class=cF0>
|
|
<a name="l687"></a> buf_size_tmp -= byte_count;
|
|
<a name="l688"></a> internal_buf_tmp += byte_count;
|
|
<a name="l689"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l690"></a> </span><span class=cF2>//Setup the command FIS.</span><span class=cF0>
|
|
<a name="l691"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l692"></a>
|
|
<a name="l693"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l694"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS</span><span class=cF0>
|
|
<a name="l695"></a>
|
|
<a name="l696"></a> </span><span class=cF1>if</span><span class=cF0> (write) </span><span class=cF2>//Assumed support for LBA48.</span><span class=cF0>
|
|
<a name="l697"></a> cmd_fis->command = </span><span class=cF3>ATA_WRITE_DMA_EXT</span><span class=cF0>;
|
|
<a name="l698"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l699"></a> cmd_fis->command = </span><span class=cF3>ATA_READ_DMA_EXT</span><span class=cF0>;
|
|
<a name="l700"></a>
|
|
<a name="l701"></a> </span><span class=cF2>//Fill in the rest of the command FIS.</span><span class=cF0>
|
|
<a name="l702"></a> cmd_fis->lba0 = blk.u8[</span><span class=cFE>0</span><span class=cF0>];
|
|
<a name="l703"></a> cmd_fis->lba1 = blk.u8[</span><span class=cFE>1</span><span class=cF0>];
|
|
<a name="l704"></a> cmd_fis->lba2 = blk.u8[</span><span class=cFE>2</span><span class=cF0>];
|
|
<a name="l705"></a> cmd_fis->device = </span><span class=cFE>1</span><span class=cF0> << </span><span class=cFE>6</span><span class=cF0>; </span><span class=cF2>//Required as per ATA8-ACS section 7.25.3</span><span class=cF0>
|
|
<a name="l706"></a> cmd_fis->lba3 = blk.u8[</span><span class=cFE>3</span><span class=cF0>];
|
|
<a name="l707"></a> cmd_fis->lba4 = blk.u8[</span><span class=cFE>4</span><span class=cF0>];
|
|
<a name="l708"></a> cmd_fis->lba5 = blk.u8[</span><span class=cFE>5</span><span class=cF0>];
|
|
<a name="l709"></a> cmd_fis->count = count;
|
|
<a name="l710"></a>
|
|
<a name="l711"></a> </span><span class=cF2>//Wait on previous command to complete.</span><span class=cF0>
|
|
<a name="l712"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l713"></a> </span><span class=cF2>//Issue the command.</span><span class=cF0>
|
|
<a name="l714"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot);
|
|
<a name="l715"></a> </span><span class=cF2>//Wait on command to finish.</span><span class=cF0>
|
|
<a name="l716"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l717"></a>
|
|
<a name="l718"></a> </span><span class=cF1>if</span><span class=cF0> (!write) </span><span class=cF2>//If internal_buf was created it back to argument buf.</span><span class=cF0>
|
|
<a name="l719"></a> </span><span class=cF1>if</span><span class=cF0> (bd->flags & </span><span class=cF3>BDF_INTERNAL_BUF</span><span class=cF0>)
|
|
<a name="l720"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l721"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Writing back internal buffer\n";</span><span class=cF0>
|
|
<a name="l722"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(buf, internal_buf, buf_size);
|
|
<a name="l723"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l724"></a>
|
|
<a name="l725"></a> </span><span class=cF1>if</span><span class=cF0> (unlock)
|
|
<a name="l726"></a> </span><span class=cF5>BlkDevUnlock</span><span class=cF0>(bd);
|
|
<a name="l727"></a>
|
|
<a name="l728"></a> </span><span class=cF1>return</span><span class=cF0> cmd_header->prd_byte_count;
|
|
<a name="l729"></a>}
|
|
<a name="l730"></a>
|
|
<a name="l731"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cF5>AHCIAtaBlksRead</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> blk, </span><span class=cF9>I64</span><span class=cF0> count)
|
|
<a name="l732"></a>{</span><span class=cF2>//Read 'blk' amount of blocks from AHCI disk device. Returns num of bytes transferred between disk and memory.</span><span class=cF0>
|
|
<a name="l733"></a> </span><span class=cF9>I64</span><span class=cF0> byte_count = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l734"></a> </span><span class=cF1>if</span><span class=cF0> (!count)
|
|
<a name="l735"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l736"></a> </span><span class=cF1>if</span><span class=cF0> (count <= </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>)
|
|
<a name="l737"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l738"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"$GREEN$READ less than MAX_BLOCKS$FG$\n";</span><span class=cF0>
|
|
<a name="l739"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF5>AHCIAtaBlksRW</span><span class=cF0>(bd, buf, blk, count, </span><span class=cF3>FALSE</span><span class=cF0>);
|
|
<a name="l740"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l741"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l742"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l743"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"$GREEN$READ greater than MAX_BLOCKS\n";</span><span class=cF0>
|
|
<a name="l744"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"read count: %d\n$FG$", count;</span><span class=cF0>
|
|
<a name="l745"></a> </span><span class=cF1>while</span><span class=cF0> (count > </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>)
|
|
<a name="l746"></a> {
|
|
<a name="l747"></a> byte_count += </span><span class=cF5>AHCIAtaBlksRW</span><span class=cF0>(bd, buf, blk, </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>, </span><span class=cF3>FALSE</span><span class=cF0>);
|
|
<a name="l748"></a> count -= </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>;
|
|
<a name="l749"></a> blk += </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>;
|
|
<a name="l750"></a> buf += </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0> * </span><span class=cF3>BLK_SIZE</span><span class=cF0>;
|
|
<a name="l751"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"$GREEN$read count: %d\n$FG$", count;</span><span class=cF0>
|
|
<a name="l752"></a> }
|
|
<a name="l753"></a> byte_count += </span><span class=cF5>AHCIAtaBlksRW</span><span class=cF0>(bd, buf, blk, count, </span><span class=cF3>FALSE</span><span class=cF0>);
|
|
<a name="l754"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l755"></a>
|
|
<a name="l756"></a> </span><span class=cFB>blkdev</span><span class=cF0>.read_count += (count * bd->blk_size) >> </span><span class=cF3>BLK_SIZE_BITS</span><span class=cF0>;
|
|
<a name="l757"></a>
|
|
<a name="l758"></a> </span><span class=cF1>return</span><span class=cF0> byte_count;
|
|
<a name="l759"></a>}
|
|
<a name="l760"></a>
|
|
<a name="l761"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cF5>AHCIAtaBlksWrite</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> blk, </span><span class=cF9>I64</span><span class=cF0> count)
|
|
<a name="l762"></a>{</span><span class=cF2>//Write 'blk' amount of blocks to AHCI disk device. Returns num of bytes transferred between memory and disk.</span><span class=cF0>
|
|
<a name="l763"></a> </span><span class=cF9>I64</span><span class=cF0> byte_count = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l764"></a>
|
|
<a name="l765"></a> </span><span class=cF1>if</span><span class=cF0> (!count)
|
|
<a name="l766"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l767"></a> </span><span class=cF1>if</span><span class=cF0> (count <= </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>)
|
|
<a name="l768"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l769"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"$GREEN$WRITE less than MAX_BLOCKS$FG$\n";</span><span class=cF0>
|
|
<a name="l770"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF5>AHCIAtaBlksRW</span><span class=cF0>(bd, buf, blk, count, </span><span class=cF3>TRUE</span><span class=cF0>);
|
|
<a name="l771"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l772"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l773"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l774"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"$GREEN$WRITE greater than MAX_BLOCKS\n";</span><span class=cF0>
|
|
<a name="l775"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"write count: %d$FG$\n", count;</span><span class=cF0>
|
|
<a name="l776"></a> </span><span class=cF1>while</span><span class=cF0> (count > </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>)
|
|
<a name="l777"></a> {
|
|
<a name="l778"></a> byte_count += </span><span class=cF5>AHCIAtaBlksRW</span><span class=cF0>(bd, buf, blk, </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>, </span><span class=cF3>TRUE</span><span class=cF0>);
|
|
<a name="l779"></a> count -= </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>;
|
|
<a name="l780"></a> blk += </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0>;
|
|
<a name="l781"></a> buf += </span><span class=cF3>AHCI_PRDT_MAX_BLOCKS</span><span class=cF0> * </span><span class=cF3>BLK_SIZE</span><span class=cF0>;
|
|
<a name="l782"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"$GREEN$write count: %d\n$FG$\n", count;</span><span class=cF0>
|
|
<a name="l783"></a> }
|
|
<a name="l784"></a> byte_count += </span><span class=cF5>AHCIAtaBlksRW</span><span class=cF0>(bd, buf, blk, count, </span><span class=cF3>TRUE</span><span class=cF0>);
|
|
<a name="l785"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l786"></a>
|
|
<a name="l787"></a> </span><span class=cF1>return</span><span class=cF0> byte_count;
|
|
<a name="l788"></a>}
|
|
<a name="l789"></a>
|
|
<a name="l790"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cF5>AHCIAtapiBlksRead</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> blk, </span><span class=cF9>I64</span><span class=cF0> count, </span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF1>lock</span><span class=cF0>=</span><span class=cF3>TRUE</span><span class=cF0>)
|
|
<a name="l791"></a>{</span><span class=cF2>//Read 'blk' amount of blocks from from AHCI ATAPI device. Returns num of bytes transferred.</span><span class=cF0>
|
|
<a name="l792"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l793"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l794"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l795"></a> </span><span class=cF9>I64</span><span class=cF0> i, byte_count, buf_size, buf_size_tmp, prdt_len, cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l796"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l797"></a> </span><span class=cF1>U8</span><span class=cF0> *internal_buf, *internal_buf_tmp;
|
|
<a name="l798"></a> </span><span class=cF9>CAtapiReadCmd</span><span class=cF0> read_cmd;
|
|
<a name="l799"></a> </span><span class=cF1>Bool</span><span class=cF0> unlock;
|
|
<a name="l800"></a>
|
|
<a name="l801"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l802"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l803"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATAPI drive!\n"</span><span class=cF0>);
|
|
<a name="l804"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l805"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l806"></a> </span><span class=cF1>if</span><span class=cF0> (count < </span><span class=cFE>1</span><span class=cF0>)
|
|
<a name="l807"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l808"></a>
|
|
<a name="l809"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF1>lock</span><span class=cF0>)
|
|
<a name="l810"></a> unlock = </span><span class=cF5>BlkDevLock</span><span class=cF0>(bd);
|
|
<a name="l811"></a>
|
|
<a name="l812"></a> buf_size = buf_size_tmp = count * </span><span class=cF3>DVD_BLK_SIZE</span><span class=cF0>;
|
|
<a name="l813"></a> prdt_len = (buf_size - </span><span class=cFE>1</span><span class=cF0>) / </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0> + </span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l814"></a>
|
|
<a name="l815"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"PRDT Length:\t%d\n", prdt_len;</span><span class=cF0>
|
|
<a name="l816"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Count:\t\t\t%d\n", count;</span><span class=cF0>
|
|
<a name="l817"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Buffer size:\t%X\n", buf_size;</span><span class=cF0>
|
|
<a name="l818"></a>
|
|
<a name="l819"></a> cmd_header->prdt_len = prdt_len;
|
|
<a name="l820"></a>
|
|
<a name="l821"></a> internal_buf = internal_buf_tmp = </span><span class=cFD>AHCIBufferAlign</span><span class=cF0>(bd, buf, buf_size, </span><span class=cF3>FALSE</span><span class=cF0>);
|
|
<a name="l822"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Buffer:\t\t\t0x%X\n", internal_buf;</span><span class=cF0>
|
|
<a name="l823"></a>
|
|
<a name="l824"></a> </span><span class=cF1>if</span><span class=cF0> (!internal_buf) </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l825"></a>
|
|
<a name="l826"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_A</span><span class=cF0>); </span><span class=cF2>//Set ATAPI flag in command header</span><span class=cF0>
|
|
<a name="l827"></a>
|
|
<a name="l828"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l829"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l830"></a>
|
|
<a name="l831"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < prdt_len; i++)
|
|
<a name="l832"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l833"></a> </span><span class=cF1>if</span><span class=cF0> (buf_size_tmp > </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0>) </span><span class=cF2>//SHOULD PROBABLY BE ATAPI MAX BYTES</span><span class=cF0>
|
|
<a name="l834"></a> byte_count = </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0>;
|
|
<a name="l835"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l836"></a> byte_count = buf_size_tmp;
|
|
<a name="l837"></a>
|
|
<a name="l838"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"prdt[%d].data_base_addr = 0x%X\n" , i, internal_buf_tmp;</span><span class=cF0>
|
|
<a name="l839"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"prdt[%d].data_byte_count = 0x%X\n\n", i, byte_count;</span><span class=cF0>
|
|
<a name="l840"></a> cmd_table->prdt[i].data_base = internal_buf_tmp;
|
|
<a name="l841"></a> cmd_table->prdt[i].data_byte_count = byte_count - </span><span class=cFE>1</span><span class=cF0>; </span><span class=cF2>//Zero-based value</span><span class=cF0>
|
|
<a name="l842"></a>
|
|
<a name="l843"></a> buf_size_tmp -= byte_count;
|
|
<a name="l844"></a> internal_buf_tmp += byte_count;
|
|
<a name="l845"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l846"></a>
|
|
<a name="l847"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l848"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_fis, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CFisH2D</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l849"></a>
|
|
<a name="l850"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l851"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS </span><span class=cF0>
|
|
<a name="l852"></a>
|
|
<a name="l853"></a> cmd_fis->feature_low = </span><span class=cFE>1</span><span class=cF0>; </span><span class=cF2>//Necessary?</span><span class=cF0>
|
|
<a name="l854"></a> cmd_fis->command = </span><span class=cF3>ATA_PACKET</span><span class=cF0>;
|
|
<a name="l855"></a>
|
|
<a name="l856"></a> </span><span class=cF5>MemSet</span><span class=cF0>(&read_cmd, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CAtapiReadCmd</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l857"></a> read_cmd.command = </span><span class=cF3>ATAPI_READ</span><span class=cF0> >> </span><span class=cFE>8</span><span class=cF0>; </span><span class=cF2>//FIX</span><span class=cF0>
|
|
<a name="l858"></a> read_cmd.lba = </span><span class=cF5>EndianU32</span><span class=cF0>(blk);
|
|
<a name="l859"></a> read_cmd.count = </span><span class=cF5>EndianU32</span><span class=cF0>(count);
|
|
<a name="l860"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(&cmd_table->acmd, &read_cmd, </span><span class=cFE>16</span><span class=cF0>);
|
|
<a name="l861"></a>
|
|
<a name="l862"></a> cmd_fis->count = count; </span><span class=cF2>//Necessary?</span><span class=cF0>
|
|
<a name="l863"></a>
|
|
<a name="l864"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l865"></a>
|
|
<a name="l866"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot);
|
|
<a name="l867"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l868"></a>
|
|
<a name="l869"></a> </span><span class=cF1>if</span><span class=cF0> (bd->flags & </span><span class=cF3>BDF_INTERNAL_BUF</span><span class=cF0>)
|
|
<a name="l870"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l871"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Writing back internal buffer\n";</span><span class=cF0>
|
|
<a name="l872"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(buf, internal_buf, buf_size);
|
|
<a name="l873"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l874"></a>
|
|
<a name="l875"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF1>lock</span><span class=cF0> && unlock)
|
|
<a name="l876"></a> </span><span class=cF5>BlkDevUnlock</span><span class=cF0>(bd);
|
|
<a name="l877"></a>
|
|
<a name="l878"></a> </span><span class=cF1>return</span><span class=cF0> cmd_header->prd_byte_count;
|
|
<a name="l879"></a>}
|
|
<a name="l880"></a>
|
|
<a name="l881"></a></span><span class=cF9>I64</span><span class=cF0> </span><span class=cFD>AHCIAtapiBlksWrite</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> blk, </span><span class=cF9>I64</span><span class=cF0> count, </span><span class=cF1>Bool</span><span class=cF0> </span><span class=cF1>lock</span><span class=cF0>=</span><span class=cF3>TRUE</span><span class=cF0>)
|
|
<a name="l882"></a>{ </span><span class=cF2>// untested</span><span class=cF0>
|
|
<a name="l883"></a> </span><span class=cF9>CPortCmdTable</span><span class=cF0> *cmd_table;
|
|
<a name="l884"></a> </span><span class=cF9>CFisH2D</span><span class=cF0> *cmd_fis;
|
|
<a name="l885"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port = bd->ahci_port;
|
|
<a name="l886"></a> </span><span class=cF9>I64</span><span class=cF0> i, byte_count, buf_size, buf_size_tmp, prdt_len, cmd_slot;
|
|
<a name="l887"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header;
|
|
<a name="l888"></a> </span><span class=cF1>U8</span><span class=cF0> *internal_buf, *internal_buf_tmp;
|
|
<a name="l889"></a> </span><span class=cF1>Bool</span><span class=cF0> unlock;
|
|
<a name="l890"></a>
|
|
<a name="l891"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature != </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l892"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l893"></a> </span><span class=cF5>SysErr</span><span class=cF0>(</span><span class=cF6>"AHCI: Drive is not an ATAPI drive!\n"</span><span class=cF0>);
|
|
<a name="l894"></a> </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l895"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l896"></a> </span><span class=cF1>if</span><span class=cF0> (count < </span><span class=cFE>1</span><span class=cF0>)
|
|
<a name="l897"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l898"></a>
|
|
<a name="l899"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF1>lock</span><span class=cF0>)
|
|
<a name="l900"></a> unlock = </span><span class=cF5>BlkDevLock</span><span class=cF0>(bd);
|
|
<a name="l901"></a>
|
|
<a name="l902"></a>
|
|
<a name="l903"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l904"></a> </span><span class=cF5>AHCIAtapiSeek</span><span class=cF0>(bd, blk);
|
|
<a name="l905"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l906"></a> </span><span class=cFD>AHCIAtapiFormat</span><span class=cF0>(bd, count); </span><span class=cF2>// ??..</span><span class=cF0>
|
|
<a name="l907"></a> bd->flags |= </span><span class=cF3>BDF_LAST_WAS_WRITE</span><span class=cF0>; </span><span class=cF2>// ??..</span><span class=cF0>
|
|
<a name="l908"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l909"></a> </span><span class=cF5>AHCIAtapiSeek</span><span class=cF0>(bd, blk);
|
|
<a name="l910"></a>
|
|
<a name="l911"></a> cmd_slot = </span><span class=cFD>AHCIPortCmdSlotGet</span><span class=cF0>(bd->port_num);
|
|
<a name="l912"></a> cmd_header = </span><span class=cFD>AHCIPortActiveHeaderGet</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l913"></a>
|
|
<a name="l914"></a> buf_size = buf_size_tmp = count * </span><span class=cF3>DVD_BLK_SIZE</span><span class=cF0>;
|
|
<a name="l915"></a> prdt_len = (buf_size - </span><span class=cFE>1</span><span class=cF0>) / </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0> + </span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l916"></a>
|
|
<a name="l917"></a> cmd_header->prdt_len = prdt_len;
|
|
<a name="l918"></a>
|
|
<a name="l919"></a> internal_buf = internal_buf_tmp = </span><span class=cFD>AHCIBufferAlign</span><span class=cF0>(bd, buf, buf_size, </span><span class=cF3>FALSE</span><span class=cF0>);
|
|
<a name="l920"></a>
|
|
<a name="l921"></a> </span><span class=cF1>if</span><span class=cF0> (!internal_buf) </span><span class=cF5>throw</span><span class=cF0>(</span><span class=cF6>'AHCI'</span><span class=cF0>);
|
|
<a name="l922"></a>
|
|
<a name="l923"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_A</span><span class=cF0>); </span><span class=cF2>//Set ATAPI flag in command header</span><span class=cF0>
|
|
<a name="l924"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_header->desc, </span><span class=cF3>AHCI_CH_DESCf_W</span><span class=cF0>); </span><span class=cF2>//Set WRITE flag in command header</span><span class=cF0>
|
|
<a name="l925"></a>
|
|
<a name="l926"></a> cmd_table = cmd_header->cmd_table_base;
|
|
<a name="l927"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_table, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l928"></a>
|
|
<a name="l929"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < prdt_len; i++)
|
|
<a name="l930"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l931"></a> </span><span class=cF1>if</span><span class=cF0> (buf_size_tmp > </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0>) </span><span class=cF2>//SHOULD PROBABLY BE ATAPI MAX BYTES</span><span class=cF0>
|
|
<a name="l932"></a> byte_count = </span><span class=cF3>AHCI_PRD_MAX_BYTES</span><span class=cF0>;
|
|
<a name="l933"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l934"></a> byte_count = buf_size_tmp;
|
|
<a name="l935"></a> cmd_table->prdt[i].data_base = internal_buf_tmp;
|
|
<a name="l936"></a> cmd_table->prdt[i].data_byte_count = byte_count - </span><span class=cFE>1</span><span class=cF0>; </span><span class=cF2>//Zero-based value</span><span class=cF0>
|
|
<a name="l937"></a>
|
|
<a name="l938"></a> buf_size_tmp -= byte_count;
|
|
<a name="l939"></a> internal_buf_tmp += byte_count;
|
|
<a name="l940"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l941"></a>
|
|
<a name="l942"></a> cmd_fis = cmd_table->cmd_fis;
|
|
<a name="l943"></a> </span><span class=cF5>MemSet</span><span class=cF0>(cmd_fis, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CFisH2D</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l944"></a>
|
|
<a name="l945"></a> cmd_fis->type = </span><span class=cF3>FISt_H2D</span><span class=cF0>;
|
|
<a name="l946"></a> </span><span class=cF5>Bts</span><span class=cF0>(&cmd_fis->desc, </span><span class=cF3>AHCI_CF_DESCf_C</span><span class=cF0>); </span><span class=cF2>//Set Command bit in H2D FIS </span><span class=cF0>
|
|
<a name="l947"></a> cmd_fis->command = </span><span class=cF3>ATA_PACKET</span><span class=cF0>;
|
|
<a name="l948"></a> cmd_table->acmd[</span><span class=cFE>0</span><span class=cF0>] =</span><span class=cF3>ATAPI_WRITE</span><span class=cF0> >> </span><span class=cFE>8</span><span class=cF0>;
|
|
<a name="l949"></a> cmd_table->acmd[</span><span class=cFE>2</span><span class=cF0>] = blk.u8[</span><span class=cFE>3</span><span class=cF0>];
|
|
<a name="l950"></a> cmd_table->acmd[</span><span class=cFE>3</span><span class=cF0>] = blk.u8[</span><span class=cFE>2</span><span class=cF0>];
|
|
<a name="l951"></a> cmd_table->acmd[</span><span class=cFE>4</span><span class=cF0>] = blk.u8[</span><span class=cFE>1</span><span class=cF0>];
|
|
<a name="l952"></a> cmd_table->acmd[</span><span class=cFE>5</span><span class=cF0>] = blk.u8[</span><span class=cFE>0</span><span class=cF0>];
|
|
<a name="l953"></a> cmd_table->acmd[</span><span class=cFE>6</span><span class=cF0>] = count.u8[</span><span class=cFE>3</span><span class=cF0>];
|
|
<a name="l954"></a> cmd_table->acmd[</span><span class=cFE>7</span><span class=cF0>] = count.u8[</span><span class=cFE>2</span><span class=cF0>];
|
|
<a name="l955"></a> cmd_table->acmd[</span><span class=cFE>8</span><span class=cF0>] = count.u8[</span><span class=cFE>1</span><span class=cF0>];
|
|
<a name="l956"></a> cmd_table->acmd[</span><span class=cFE>9</span><span class=cF0>] = count.u8[</span><span class=cFE>0</span><span class=cF0>];
|
|
<a name="l957"></a>
|
|
<a name="l958"></a> cmd_fis->count = count; </span><span class=cF2>//Necessary?</span><span class=cF0>
|
|
<a name="l959"></a>
|
|
<a name="l960"></a> </span><span class=cFD>AHCIPortWait</span><span class=cF0>(bd->port_num, </span><span class=cF5>tS</span><span class=cF0> + </span><span class=cFE>2</span><span class=cF0>);
|
|
<a name="l961"></a>
|
|
<a name="l962"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->cmd_issue, cmd_slot);
|
|
<a name="l963"></a> </span><span class=cFD>AHCIPortCmdWait</span><span class=cF0>(bd->port_num, cmd_slot);
|
|
<a name="l964"></a>
|
|
<a name="l965"></a> </span><span class=cF1>if</span><span class=cF0> (bd->flags & </span><span class=cF3>BDF_INTERNAL_BUF</span><span class=cF0>)
|
|
<a name="l966"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l967"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"Writing back internal buffer\n";</span><span class=cF0>
|
|
<a name="l968"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(buf, internal_buf, buf_size);
|
|
<a name="l969"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l970"></a>
|
|
<a name="l971"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF1>lock</span><span class=cF0> && unlock)
|
|
<a name="l972"></a> </span><span class=cF5>BlkDevUnlock</span><span class=cF0>(bd);
|
|
<a name="l973"></a>
|
|
<a name="l974"></a> </span><span class=cF1>return</span><span class=cF0> cmd_header->prd_byte_count;
|
|
<a name="l975"></a>}
|
|
<a name="l976"></a>
|
|
<a name="l977"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cF5>AHCIPortInit</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd, </span><span class=cF9>CAHCIPort</span><span class=cF0> *port, </span><span class=cF9>I64</span><span class=cF0> port_num)
|
|
<a name="l978"></a>{</span><span class=cF2>//Initialize base addresses for command list and FIS receive area and start command execution on port.</span><span class=cF0>
|
|
<a name="l979"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header;
|
|
<a name="l980"></a> </span><span class=cF9>I64</span><span class=cF0> i;
|
|
<a name="l981"></a>
|
|
<a name="l982"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cF7>(</span><span class=cF0>port->signature == </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0> || port->signature == </span><span class=cF3>AHCI_PxSIG_ATA</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l983"></a> </span><span class=cF5>Debug</span><span class=cF0>(</span><span class=cF6>"AHCI Port/BlkDev error: Invalid Port Signature"</span><span class=cF0>);
|
|
<a name="l984"></a>
|
|
<a name="l985"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Letter2BlkDevType</span><span class=cF7>(</span><span class=cF0>bd->first_drive_let</span><span class=cF7>)</span><span class=cF0> == </span><span class=cF3>BDT_ATA</span><span class=cF0> && port->signature == </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l986"></a> </span><span class=cF5>Debug</span><span class=cF0>(</span><span class=cF6>"AHCI Port/BlkDev type mismatch: BlkDev ATA, Port ATAPI"</span><span class=cF0>);
|
|
<a name="l987"></a>
|
|
<a name="l988"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Letter2BlkDevType</span><span class=cF7>(</span><span class=cF0>bd->first_drive_let</span><span class=cF7>)</span><span class=cF0> == </span><span class=cF3>BDT_ATAPI</span><span class=cF0> && port->signature == </span><span class=cF3>AHCI_PxSIG_ATA</span><span class=cF0>)
|
|
<a name="l989"></a> </span><span class=cF5>Debug</span><span class=cF0>(</span><span class=cF6>"AHCI Port/BlkDev type mismatch: BlkDev ATAPI, Port ATA"</span><span class=cF0>);
|
|
<a name="l990"></a>
|
|
<a name="l991"></a> bd->ahci_port = port;
|
|
<a name="l992"></a> bd->port_num = port_num;
|
|
<a name="l993"></a>
|
|
<a name="l994"></a> </span><span class=cF5>AHCIPortReset</span><span class=cF0>(port_num);
|
|
<a name="l995"></a> </span><span class=cFD>AHCIPortCmdStart</span><span class=cF0>(port_num);
|
|
<a name="l996"></a>
|
|
<a name="l997"></a> </span><span class=cF2>//Spin up, power on device. If the capability isn't suppport the bits will be read-only and this won't do anything.</span><span class=cF0>
|
|
<a name="l998"></a> port->command |= </span><span class=cF3>AHCI_PxCMDF_POD</span><span class=cF0> | </span><span class=cF3>AHCI_PxCMDF_SUD</span><span class=cF0>;
|
|
<a name="l999"></a> </span><span class=cF5>Sleep</span><span class=cF0>(</span><span class=cFE>100</span><span class=cF0>); </span><span class=cF2>//Why?</span><span class=cF0>
|
|
<a name="l1000"></a> </span><span class=cFD>AHCIPortCmdStop</span><span class=cF0>(port_num);
|
|
<a name="l1001"></a>
|
|
<a name="l1002"></a> </span><span class=cF2>//'1K-byte' align as per SATA spec.</span><span class=cF0>
|
|
<a name="l1003"></a> port->cmd_list_base = </span><span class=cF5>CAllocAligned</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdHeader</span><span class=cF7>)</span><span class=cF0> * </span><span class=cFB>blkdev</span><span class=cF0>.cmd_slot_count, </span><span class=cFE>1024</span><span class=cF0>, </span><span class=cFB>sys_task</span><span class=cF0>->code_heap);
|
|
<a name="l1004"></a> port->cmd_list_base_upper = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l1005"></a>
|
|
<a name="l1006"></a> </span><span class=cF2>//Alloc where received FISes will be copied to. '256-byte' align as per spec.</span><span class=cF0>
|
|
<a name="l1007"></a> port->fis_base = </span><span class=cF5>CAllocAligned</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CFisReceived</span><span class=cF7>)</span><span class=cF0>, </span><span class=cFE>256</span><span class=cF0>, </span><span class=cFB>sys_task</span><span class=cF0>->code_heap);
|
|
<a name="l1008"></a> port->fis_base_upper = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l1009"></a>
|
|
<a name="l1010"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < </span><span class=cFB>blkdev</span><span class=cF0>.cmd_slot_count; i++)
|
|
<a name="l1011"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1012"></a> cmd_header = &port->cmd_list_base(</span><span class=cF9>CPortCmdHeader</span><span class=cF0> *)[i];
|
|
<a name="l1013"></a> </span><span class=cF2>//Write Command FIS Length (CFL, a fixed size) in bits 4:0 of the desc. Takes size in U32s.</span><span class=cF0>
|
|
<a name="l1014"></a> cmd_header->desc = </span><span class=cF1>sizeof</span><span class=cF0>(</span><span class=cF9>CFisH2D</span><span class=cF0>) / </span><span class=cF1>sizeof</span><span class=cF0>(</span><span class=cF9>U32</span><span class=cF0>);
|
|
<a name="l1015"></a>
|
|
<a name="l1016"></a> </span><span class=cF2>//'128-byte' align as per SATA spec, minus 1 since length is 1-based.</span><span class=cF0>
|
|
<a name="l1017"></a> cmd_header->cmd_table_base = </span><span class=cF5>CAllocAligned</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPortCmdTable</span><span class=cF7>)</span><span class=cF0> + </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF9>CPrdtEntry</span><span class=cF7>)</span><span class=cF0> * </span><span class=cF7>(</span><span class=cF3>AHCI_PRDT_MAX_LEN</span><span class=cF0> - </span><span class=cFE>1</span><span class=cF7>)</span><span class=cF0>, </span><span class=cFE>128</span><span class=cF0>, </span><span class=cFB>sys_task</span><span class=cF0>->code_heap);
|
|
<a name="l1018"></a> cmd_header->cmd_table_base_upper = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l1019"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1020"></a> </span><span class=cFD>AHCIPortCmdStart</span><span class=cF0>(port_num);
|
|
<a name="l1021"></a> </span><span class=cFD>AHCIPortIdentify</span><span class=cF0>(bd);
|
|
<a name="l1022"></a>}
|
|
<a name="l1023"></a>
|
|
<a name="l1024"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIAtaInit</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd)
|
|
<a name="l1025"></a>{
|
|
<a name="l1026"></a> </span><span class=cF1>Bool</span><span class=cF0> unlock, okay = </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l1027"></a> </span><span class=cF9>CPortCmdHeader</span><span class=cF0> *cmd_header;
|
|
<a name="l1028"></a> </span><span class=cF9>I64</span><span class=cF0> i;
|
|
<a name="l1029"></a>
|
|
<a name="l1030"></a> </span><span class=cF1>if</span><span class=cF0> (!bd->ahci_port)
|
|
<a name="l1031"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l1032"></a>
|
|
<a name="l1033"></a> unlock = </span><span class=cF5>BlkDevLock</span><span class=cF0>(bd);
|
|
<a name="l1034"></a>
|
|
<a name="l1035"></a> </span><span class=cF2>// if we re-init a port, keep memory from leaking.</span><span class=cF0>
|
|
<a name="l1036"></a> </span><span class=cF1>if</span><span class=cF0> (bd->ahci_port->cmd_list_base)
|
|
<a name="l1037"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1038"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < </span><span class=cFB>blkdev</span><span class=cF0>.cmd_slot_count; i++)
|
|
<a name="l1039"></a> {
|
|
<a name="l1040"></a> cmd_header = &bd->ahci_port->cmd_list_base(</span><span class=cF9>CPortCmdHeader</span><span class=cF0> *)[i];
|
|
<a name="l1041"></a> </span><span class=cF5>Free</span><span class=cF0>(cmd_header->cmd_table_base);
|
|
<a name="l1042"></a> }
|
|
<a name="l1043"></a> </span><span class=cF5>Free</span><span class=cF0>(bd->ahci_port->cmd_list_base);
|
|
<a name="l1044"></a> </span><span class=cF5>Free</span><span class=cF0>(bd->ahci_port->fis_base);
|
|
<a name="l1045"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1046"></a>
|
|
<a name="l1047"></a> </span><span class=cF2>// try to init the port, catch if fails.</span><span class=cF0>
|
|
<a name="l1048"></a> </span><span class=cF1>try</span><span class=cF0>
|
|
<a name="l1049"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1050"></a> </span><span class=cF5>AHCIPortInit</span><span class=cF0>(bd, bd->ahci_port, bd->port_num);
|
|
<a name="l1051"></a>
|
|
<a name="l1052"></a> </span><span class=cF1>if</span><span class=cF0> (bd->type == </span><span class=cF3>BDT_ATAPI</span><span class=cF0>)
|
|
<a name="l1053"></a> okay = </span><span class=cF5>AHCIAtapiStartStop</span><span class=cF0>(bd, </span><span class=cF3>TRUE</span><span class=cF0>);
|
|
<a name="l1054"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l1055"></a> okay = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l1056"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1057"></a> </span><span class=cF1>catch</span><span class=cF0>
|
|
<a name="l1058"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1059"></a> </span><span class=cF5>Fs</span><span class=cF0>->catch_except = </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l1060"></a> okay = </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l1061"></a> </span><span class=cF3>ST_WARN_ST</span><span class=cF0> </span><span class=cF6>"AHCIAtaInit"</span><span class=cF0>;
|
|
<a name="l1062"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1063"></a>
|
|
<a name="l1064"></a> </span><span class=cF1>if</span><span class=cF0> (unlock)
|
|
<a name="l1065"></a> </span><span class=cF5>BlkDevUnlock</span><span class=cF0>(bd);
|
|
<a name="l1066"></a>
|
|
<a name="l1067"></a> </span><span class=cF1>return</span><span class=cF0> okay;
|
|
<a name="l1068"></a>}
|
|
<a name="l1069"></a>
|
|
<a name="l1070"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cF5>AHCIHbaReset</span><span class=cF0>()
|
|
<a name="l1071"></a>{
|
|
<a name="l1072"></a> </span><span class=cF5>Bts</span><span class=cF0>(&</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ghc, </span><span class=cF3>AHCI_GHCf_HBA_RESET</span><span class=cF0>);
|
|
<a name="l1073"></a> </span><span class=cF1>while</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ghc, </span><span class=cF3>AHCI_GHCf_HBA_RESET</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l1074"></a> </span><span class=cF5>Bts</span><span class=cF0>(&</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ghc, </span><span class=cF3>AHCI_GHCf_AHCI_ENABLE</span><span class=cF0>);
|
|
<a name="l1075"></a>}
|
|
<a name="l1076"></a>
|
|
<a name="l1077"></a></span><span class=cF1>U0</span><span class=cF0> </span><span class=cFD>AHCIInit</span><span class=cF0>()
|
|
<a name="l1078"></a>{
|
|
<a name="l1079"></a> </span><span class=cF9>CAHCIHba</span><span class=cF0> *hba;
|
|
<a name="l1080"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port;
|
|
<a name="l1081"></a> </span><span class=cF9>I64</span><span class=cF0> i, bdf = </span><span class=cF5>PCIClassFind</span><span class=cF0>(</span><span class=cF3>PCIC_STORAGE</span><span class=cF0> << </span><span class=cFE>16</span><span class=cF0> | </span><span class=cF3>PCISC_AHCI</span><span class=cF0> << </span><span class=cFE>8</span><span class=cF0> + </span><span class=cFE>1</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>); </span><span class=cF2>//0x010601, last byte prog_if, AHCI version 1.0</span><span class=cF0>
|
|
<a name="l1082"></a>
|
|
<a name="l1083"></a> </span><span class=cF6>"\n"</span><span class=cF0>;
|
|
<a name="l1084"></a>
|
|
<a name="l1085"></a> </span><span class=cF1>if</span><span class=cF0> (bdf == -</span><span class=cFE>1</span><span class=cF0>)
|
|
<a name="l1086"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1087"></a> </span><span class=cF6>"AHCI: No AHCI controller found.\n"</span><span class=cF0>;
|
|
<a name="l1088"></a> </span><span class=cF1>return</span><span class=cF0>;
|
|
<a name="l1089"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1090"></a>
|
|
<a name="l1091"></a> </span><span class=cF6>"AHCI: Controller found\n"</span><span class=cF0>;
|
|
<a name="l1092"></a> hba = </span><span class=cFB>dev</span><span class=cF0>.uncached_alias + </span><span class=cF5>PCIReadU32</span><span class=cF0>(bdf.u8[</span><span class=cFE>2</span><span class=cF0>], bdf.u8[</span><span class=cFE>1</span><span class=cF0>], bdf.u8[</span><span class=cFE>0</span><span class=cF0>], </span><span class=cF3>PCIR_BASE5</span><span class=cF0>) & ~</span><span class=cFE>0x1F</span><span class=cF0>; </span><span class=cF2>//Last 4 bits not part of address.</span><span class=cF0>
|
|
<a name="l1093"></a> </span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba = hba;
|
|
<a name="l1094"></a>
|
|
<a name="l1095"></a>
|
|
<a name="l1096"></a> </span><span class=cF5>Bts</span><span class=cF0>(&</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ghc, </span><span class=cF3>AHCI_GHCf_AHCI_ENABLE</span><span class=cF0>);
|
|
<a name="l1097"></a> </span><span class=cF6>"AHCI: GHC.AE\n"</span><span class=cF0>;
|
|
<a name="l1098"></a>
|
|
<a name="l1099"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>AHCIHbaReset;</span><span class=cF0>
|
|
<a name="l1100"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"AHCI: HBA Reset\n";</span><span class=cF0>
|
|
<a name="l1101"></a>
|
|
<a name="l1102"></a>
|
|
<a name="l1103"></a> </span><span class=cF2>//Transferring ownership from BIOS if supported.</span><span class=cF0>
|
|
<a name="l1104"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&hba->caps_ext, </span><span class=cF3>AHCI_CAPSEXTf_BOH</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l1105"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1106"></a> </span><span class=cF5>Bts</span><span class=cF0>(&hba->bohc, </span><span class=cF3>AHCI_BOHCf_OOS</span><span class=cF0>);
|
|
<a name="l1107"></a> </span><span class=cF6>"AHCI: Transferring ownership from BIOS\n"</span><span class=cF0>;
|
|
<a name="l1108"></a>
|
|
<a name="l1109"></a> </span><span class=cF1>while</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&hba->bohc, </span><span class=cF3>AHCI_BOHCf_BOS</span><span class=cF7>)</span><span class=cF0>);
|
|
<a name="l1110"></a>
|
|
<a name="l1111"></a> </span><span class=cF5>Sleep</span><span class=cF0>(</span><span class=cFE>25</span><span class=cF0>);
|
|
<a name="l1112"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&hba->bohc, </span><span class=cF3>AHCI_BOHCf_BB</span><span class=cF7>)</span><span class=cF0>) </span><span class=cF2>//if Bios Busy is still set after 25 mS, wait 2 seconds.</span><span class=cF0>
|
|
<a name="l1113"></a> </span><span class=cF5>Sleep</span><span class=cF0>(</span><span class=cFE>2000</span><span class=cF0>);
|
|
<a name="l1114"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1115"></a>
|
|
<a name="l1116"></a> </span><span class=cFB>blkdev</span><span class=cF0>.cmd_slot_count = (hba->caps & </span><span class=cFE>0x1F00</span><span class=cF0>) >> </span><span class=cFE>8</span><span class=cF0>;
|
|
<a name="l1117"></a> </span><span class=cF6>"AHCI: Command slot count: %d\n"</span><span class=cF0>, </span><span class=cFB>blkdev</span><span class=cF0>.cmd_slot_count;
|
|
<a name="l1118"></a>
|
|
<a name="l1119"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < </span><span class=cF3>AHCI_MAX_PORTS</span><span class=cF0>; i++)
|
|
<a name="l1120"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1121"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&hba->ports_implemented, i</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l1122"></a> {</span><span class=cF2>//Make ports idle?</span><span class=cF0>
|
|
<a name="l1123"></a> port = &hba->ports[i];
|
|
<a name="l1124"></a> </span><span class=cF6>"AHCI: Port %2d signature 0x%08X "</span><span class=cF0>, i, port->signature;
|
|
<a name="l1125"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature == </span><span class=cF3>AHCI_PxSIG_ATA</span><span class=cF0> || port->signature == </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l1126"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1127"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature == </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l1128"></a> {
|
|
<a name="l1129"></a> </span><span class=cF5>Bts</span><span class=cF0>(&port->command, </span><span class=cF3>AHCI_PxCMDf_ATAPI</span><span class=cF0>);
|
|
<a name="l1130"></a> </span><span class=cF6>"ATAPI drive\n"</span><span class=cF0>;
|
|
<a name="l1131"></a> }
|
|
<a name="l1132"></a> </span><span class=cF1>else</span><span class=cF0> </span><span class=cF1>if</span><span class=cF0> (port->signature == </span><span class=cF3>AHCI_PxSIG_ATA</span><span class=cF0>)
|
|
<a name="l1133"></a> </span><span class=cF6>"ATA drive\n"</span><span class=cF0>;
|
|
<a name="l1134"></a>
|
|
<a name="l1135"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cFD>AHCIPortIsIdle</span><span class=cF7>(</span><span class=cF0>i</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l1136"></a> {
|
|
<a name="l1137"></a> </span><span class=cF6>"AHCI: Port not idle\n"</span><span class=cF0>;
|
|
<a name="l1138"></a> </span><span class=cFD>AHCIPortCmdStop</span><span class=cF0>(i);
|
|
<a name="l1139"></a> }
|
|
<a name="l1140"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1141"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l1142"></a> </span><span class=cF6>"Unknown\n"</span><span class=cF0>;
|
|
<a name="l1143"></a> }
|
|
<a name="l1144"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1145"></a> </span><span class=cF6>"\n"</span><span class=cF0>;
|
|
<a name="l1146"></a>}
|
|
<a name="l1147"></a>
|
|
<a name="l1148"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIBootDVDProbeAll</span><span class=cF0>(</span><span class=cF9>CBlkDev</span><span class=cF0> *bd)
|
|
<a name="l1149"></a>{
|
|
<a name="l1150"></a> </span><span class=cF9>I64</span><span class=cF0> i;
|
|
<a name="l1151"></a> </span><span class=cF9>CAHCIPort</span><span class=cF0> *port;
|
|
<a name="l1152"></a> </span><span class=cF1>U8</span><span class=cF0> *buf = </span><span class=cF5>CAlloc</span><span class=cF0>(</span><span class=cF3>DVD_BLK_SIZE</span><span class=cF0>);
|
|
<a name="l1153"></a> </span><span class=cF9>CKernel</span><span class=cF0> *kernel;
|
|
<a name="l1154"></a>
|
|
<a name="l1155"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i < </span><span class=cF3>AHCI_MAX_PORTS</span><span class=cF0>; i++)
|
|
<a name="l1156"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1157"></a> </span><span class=cF1>if</span><span class=cF0> (</span><span class=cF5>Bt</span><span class=cF7>(</span><span class=cF0>&</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports_implemented, i</span><span class=cF7>)</span><span class=cF0>)
|
|
<a name="l1158"></a> {
|
|
<a name="l1159"></a> port = &</span><span class=cFB>blkdev</span><span class=cF0>.ahci_hba->ports[i];
|
|
<a name="l1160"></a> </span><span class=cF6>"AHCI: BootDVDProbeAll: Saw port at %2d with signature 0x%0X\n"</span><span class=cF0>, i, port->signature;
|
|
<a name="l1161"></a>
|
|
<a name="l1162"></a> </span><span class=cF1>if</span><span class=cF0> (port->signature == </span><span class=cF3>AHCI_PxSIG_ATAPI</span><span class=cF0>)
|
|
<a name="l1163"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1164"></a> </span><span class=cF6>"AHCI: Probing ATAPI drive at port %d\n"</span><span class=cF0>, i;
|
|
<a name="l1165"></a>
|
|
<a name="l1166"></a> </span><span class=cF5>AHCIPortInit</span><span class=cF0>(bd, port, i);
|
|
<a name="l1167"></a>
|
|
<a name="l1168"></a> </span><span class=cF5>AHCIAtapiBlksRead</span><span class=cF0>(bd, buf, </span><span class=cFB>sys_boot_blk</span><span class=cF0>, </span><span class=cFE>1</span><span class=cF0>, </span><span class=cF3>FALSE</span><span class=cF0>);
|
|
<a name="l1169"></a>
|
|
<a name="l1170"></a> kernel = buf + </span><span class=cFB>sys_boot_src</span><span class=cF0>.u16[</span><span class=cFE>1</span><span class=cF0>] << </span><span class=cF3>BLK_SIZE_BITS</span><span class=cF0>;
|
|
<a name="l1171"></a>
|
|
<a name="l1172"></a> </span><span class=cF1>if</span><span class=cF0> (kernel->compile_time == </span><span class=cFB>sys_compile_time</span><span class=cF0>)
|
|
<a name="l1173"></a> {
|
|
<a name="l1174"></a> </span><span class=cF6>"AHCI: Found sys_compile_time at BLK %d on Port %d\n"</span><span class=cF0>, </span><span class=cFB>sys_boot_blk</span><span class=cF0>, i;
|
|
<a name="l1175"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l1176"></a> }
|
|
<a name="l1177"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l1178"></a> </span><span class=cF6>"AHCI: Did not find matching sys_compile_time on Port %d\n"</span><span class=cF0>, i;
|
|
<a name="l1179"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1180"></a> }
|
|
<a name="l1181"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1182"></a>
|
|
<a name="l1183"></a> </span><span class=cF5>Panic</span><span class=cF0>(</span><span class=cF6>"Could not find ATAPI boot drive"</span><span class=cF0>);
|
|
<a name="l1184"></a>
|
|
<a name="l1185"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l1186"></a>}
|
|
<a name="l1187"></a>
|
|
<a name="l1188"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIAtapiRBlks</span><span class=cF0>(</span><span class=cF9>CDrive</span><span class=cF0> *drive, </span><span class=cF1>U8</span><span class=cF0> *buf, </span><span class=cF9>I64</span><span class=cF0> blk, </span><span class=cF9>I64</span><span class=cF0> count)
|
|
<a name="l1189"></a>{
|
|
<a name="l1190"></a> </span><span class=cF9>CBlkDev</span><span class=cF0> *bd = drive->bd;
|
|
<a name="l1191"></a> </span><span class=cF9>I64</span><span class=cF0> spc = bd->blk_size >> </span><span class=cF3>BLK_SIZE_BITS</span><span class=cF0>, n, blk2,
|
|
<a name="l1192"></a> l2 = bd->max_reads << </span><span class=cFE>1</span><span class=cF0> + spc << </span><span class=cFE>1</span><span class=cF0>;
|
|
<a name="l1193"></a> </span><span class=cF1>U8</span><span class=cF0> *dvd_buf;</span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>= MAlloc(l2 << BLK_SIZE_BITS);</span><span class=cF0>
|
|
<a name="l1194"></a>
|
|
<a name="l1195"></a> </span><span class=cF1>if</span><span class=cF0> (bd->type == </span><span class=cF3>BDT_ATAPI</span><span class=cF0>)
|
|
<a name="l1196"></a> </span><span class=cF7>{</span><span class=cF0>
|
|
<a name="l1197"></a> dvd_buf = </span><span class=cF5>MAlloc</span><span class=cF0>(l2 << </span><span class=cF3>BLK_SIZE_BITS</span><span class=cF0>);
|
|
<a name="l1198"></a>
|
|
<a name="l1199"></a> </span><span class=cF1>if</span><span class=cF0> (blk <= bd->max_reads)
|
|
<a name="l1200"></a> blk2 = </span><span class=cFE>0</span><span class=cF0>;
|
|
<a name="l1201"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l1202"></a> blk2 = </span><span class=cF5>FloorU64</span><span class=cF0>(blk - bd->max_reads, spc);
|
|
<a name="l1203"></a>
|
|
<a name="l1204"></a> </span><span class=cF1>if</span><span class=cF0> (blk2 + l2 > drive->size + drive->drv_offset)
|
|
<a name="l1205"></a> l2 = drive->size + drive->drv_offset - blk2;
|
|
<a name="l1206"></a>
|
|
<a name="l1207"></a> n = (l2 + spc - </span><span class=cFE>1</span><span class=cF0>) / spc;
|
|
<a name="l1208"></a>
|
|
<a name="l1209"></a></span><span class=cF2>//</span><span class=cF0> </span><span class=cF2>"AHCIAtapiBlksRead(bd, dvd_buf, %d, %d);", blk2 / spc, n;</span><span class=cF0>
|
|
<a name="l1210"></a> </span><span class=cF5>AHCIAtapiBlksRead</span><span class=cF0>(bd, dvd_buf, blk2 / spc, n);
|
|
<a name="l1211"></a>
|
|
<a name="l1212"></a> </span><span class=cF1>if</span><span class=cF0> (bd->flags & </span><span class=cF3>BDF_READ_CACHE</span><span class=cF0>)
|
|
<a name="l1213"></a> </span><span class=cFD>DiskCacheAdd</span><span class=cF0>(drive, dvd_buf, blk2, n * spc);
|
|
<a name="l1214"></a>
|
|
<a name="l1215"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(buf, dvd_buf + </span><span class=cF7>(</span><span class=cF0>blk - blk2</span><span class=cF7>)</span><span class=cF0> << </span><span class=cF3>BLK_SIZE_BITS</span><span class=cF0>, count << </span><span class=cF3>BLK_SIZE_BITS</span><span class=cF0>);
|
|
<a name="l1216"></a> </span><span class=cF5>Free</span><span class=cF0>(dvd_buf);
|
|
<a name="l1217"></a>
|
|
<a name="l1218"></a> </span><span class=cF7>}</span><span class=cF0>
|
|
<a name="l1219"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l1220"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l1221"></a>
|
|
<a name="l1222"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l1223"></a>}
|
|
<a name="l1224"></a>
|
|
<a name="l1225"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIAtaRBlks</span><span class=cF0>(</span><span class=cF9>CDrive</span><span class=cF0> *drive, </span><span class=cF1>U8</span><span class=cF0> *buf, </span><span class=cF9>I64</span><span class=cF0> blk, </span><span class=cF9>I64</span><span class=cF0> count)
|
|
<a name="l1226"></a>{
|
|
<a name="l1227"></a> </span><span class=cF9>CBlkDev</span><span class=cF0> *bd = drive->bd;
|
|
<a name="l1228"></a>
|
|
<a name="l1229"></a> </span><span class=cF1>if</span><span class=cF0> (bd->type == </span><span class=cF3>BDT_ATA</span><span class=cF0>)
|
|
<a name="l1230"></a> </span><span class=cF5>AHCIAtaBlksRead</span><span class=cF0>(bd, buf, blk, count);
|
|
<a name="l1231"></a> </span><span class=cF1>else</span><span class=cF0>
|
|
<a name="l1232"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>FALSE</span><span class=cF0>;
|
|
<a name="l1233"></a>
|
|
<a name="l1234"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l1235"></a>}
|
|
<a name="l1236"></a>
|
|
<a name="l1237"></a></span><span class=cF1>Bool</span><span class=cF0> </span><span class=cFD>AHCIAtaWBlks</span><span class=cF0>(</span><span class=cF9>CDrive</span><span class=cF0> *drive, </span><span class=cF1>U8</span><span class=cF0> *buf, </span><span class=cF9>I64</span><span class=cF0> blk, </span><span class=cF9>I64</span><span class=cF0> count)
|
|
<a name="l1238"></a>{
|
|
<a name="l1239"></a> </span><span class=cF9>CBlkDev</span><span class=cF0> *bd = drive->bd;
|
|
<a name="l1240"></a>
|
|
<a name="l1241"></a> </span><span class=cF5>AHCIAtaBlksWrite</span><span class=cF0>(bd, buf, blk, count);
|
|
<a name="l1242"></a>
|
|
<a name="l1243"></a> </span><span class=cFB>blkdev</span><span class=cF0>.write_count += count;
|
|
<a name="l1244"></a>
|
|
<a name="l1245"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cF3>TRUE</span><span class=cF0>;
|
|
<a name="l1246"></a>}
|
|
</span></pre></body>
|
|
</html>
|