2021-07-03 05:07:57 +01:00
<!DOCTYPE HTML>
< html >
< head >
< meta http-equiv = "Content-Type" content = "text/html;charset=US-ASCII" >
2021-12-11 11:10:58 +00:00
< meta name = "generator" content = "ZealOS V1.07" >
2021-07-03 05:07:57 +01:00
< style type = "text/css" >
2021-10-08 07:06:11 +01:00
body {background-color:#1f1f1f;}
.cF0{color:#e3e3e3;background-color:#1f1f1f;}
.cF1{color:#4f84a6;background-color:#1f1f1f;}
.cF2{color:#73a255;background-color:#1f1f1f;}
.cF3{color:#297582;background-color:#1f1f1f;}
.cF4{color:#b34f4b;background-color:#1f1f1f;}
.cF5{color:#8a52c3;background-color:#1f1f1f;}
.cF6{color:#b7822f;background-color:#1f1f1f;}
.cF7{color:#444444;background-color:#1f1f1f;}
.cF8{color:#6d6d6d;background-color:#1f1f1f;}
.cF9{color:#94bfde;background-color:#1f1f1f;}
.cFA{color:#a1ce97;background-color:#1f1f1f;}
.cFB{color:#6db4be;background-color:#1f1f1f;}
.cFC{color:#e88e88;background-color:#1f1f1f;}
.cFD{color:#ca94e8;background-color:#1f1f1f;}
.cFE{color:#d4b475;background-color:#1f1f1f;}
.cFF{color:#1f1f1f;background-color:#1f1f1f;}
2021-07-03 05:07:57 +01:00
< / style >
< / head >
< body >
2021-07-05 01:12:38 +01:00
< pre style = "font-family:monospace;font-size:12pt" >
2021-07-03 05:07:57 +01:00
< 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 >
2021-07-26 20:29:49 +01:00
< 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 > ;
2021-07-03 05:07:57 +01:00
< a name = "l80" > < / a >
2021-07-26 20:29:49 +01:00
< 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 >
2021-07-03 05:07:57 +01:00
< a name = "l100" > < / a > }
< a name = "l101" > < / a >
2021-07-26 20:29:49 +01:00
< 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 >
2021-08-02 21:40:05 +01:00
< 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];
2021-07-26 20:29:49 +01:00
< a name = "l156" > < / a >
2021-08-02 21:40:05 +01:00
< 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];
2021-07-26 20:29:49 +01:00
< a name = "l195" > < / a >
2021-08-02 21:40:05 +01:00
< a name = "l196" > < / a > < / span > < span class = cFD > AHCIPortCmdStop< / span > < span class = cF0 > (port_num);
2021-07-26 20:29:49 +01:00
< a name = "l197" > < / a >
2021-08-02 21:40:05 +01:00
< 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 > );
2021-07-26 20:29:49 +01:00
< a name = "l208" > < / a >
2021-08-02 21:40:05 +01:00
< 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 >
2021-08-16 05:52:03 +01:00
< 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#l2995" > < span class = cF4 > ATAS_ERR< / span > < / a > < span class = cF2 > )< / span > < span class = cF0 >
2021-08-02 21:40:05 +01:00
< 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 >
2021-07-03 05:07:57 +01:00
< a name = "l238" > < / a >
2021-08-02 21:40:05 +01:00
< 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 > ;
2021-07-26 20:29:49 +01:00
< a name = "l283" > < / a >
2021-08-02 21:40:05 +01:00
< 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 >
2021-07-26 20:29:49 +01:00
< a name = "l286" > < / a >
2021-08-02 21:40:05 +01:00
< 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 >
2021-07-26 20:29:49 +01:00
< a name = "l294" > < / a >
2021-08-02 21:40:05 +01:00
< 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 >
2021-08-15 07:23:46 +01:00
< a name = "l298" > < / 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 = "l299" > < / a > { < / span > < span class = cF2 > // Sync drive read write buffers.< / span > < span class = cF0 >
2021-08-02 21:40:05 +01:00
< 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);
2021-07-26 20:29:49 +01:00
< a name = "l305" > < / a >
2021-08-02 21:40:05 +01:00
< 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 > );
2021-07-03 05:07:57 +01:00
< a name = "l316" > < / a >
2021-08-02 21:40:05 +01:00
< 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 > ;
2021-08-15 07:23:46 +01:00
< a name = "l322" > < / 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 = "l323" > < / a >
< a name = "l324" > < / 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 = "l325" > < / 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 = "l326" > < / a >
< a name = "l327" > < / a > < / span > < span class = cF1 > try< / span > < span class = cF0 >
< a name = "l328" > < / a > < / span > < span class = cFD > AHCIPortCmdWait< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
< a name = "l329" > < / a > < / span > < span class = cF1 > catch< / span > < span class = cF0 >
< a name = "l330" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l331" > < / a > < / span > < span class = cF5 > Fs< / span > < span class = cF0 > -> catch_except = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l332" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l333" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l334" > < / a >
< a name = "l335" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l336" > < / a > }
< a name = "l337" > < / a >
< a name = "l338" > < / 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 = "l339" > < / a > { < / span > < span class = cF2 > // Close track/session on a disc.< / span > < span class = cF0 >
< a name = "l340" > < / a > < / span > < span class = cF9 > CPortCmdTable< / span > < span class = cF0 > *cmd_table;
< a name = "l341" > < / a > < / span > < span class = cF9 > CFisH2D< / span > < span class = cF0 > *cmd_fis;
< a name = "l342" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port = bd-> ahci_port;
< a name = "l343" > < / 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 = "l344" > < / 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);
2021-08-16 05:52:03 +01:00
< a name = "l345" > < / a > < / span > < span class = cF9 > CAtapiCloseCmd< / span > < span class = cF0 > close_cmd;
< a name = "l346" > < / a >
< a name = "l347" > < / 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 = "l348" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l349" > < / 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 = "l350" > < / a > < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l351" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l352" > < / a >
< a name = "l353" > < / 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 = "l354" > < / a >
< a name = "l355" > < / a > cmd_table = cmd_header-> cmd_table_base;
< a name = "l356" > < / 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 = "l357" > < / a >
< a name = "l358" > < / a > cmd_fis = cmd_table-> cmd_fis;
< a name = "l359" > < / a >
< a name = "l360" > < / a > cmd_fis-> type = < / span > < span class = cF3 > FISt_H2D< / span > < span class = cF0 > ;
< a name = "l361" > < / 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 = "l362" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_PACKET< / span > < span class = cF0 > ;
< a name = "l363" > < / a >
< a name = "l364" > < / a > < / span > < span class = cF5 > MemSet< / span > < span class = cF0 > (& close_cmd, < / span > < span class = cFE > 0< / span > < span class = cF0 > , < / span > < span class = cF1 > sizeof< / span > < span class = cF7 > (< / span > < span class = cF9 > CAtapiCloseCmd< / span > < span class = cF7 > )< / span > < span class = cF0 > );
< a name = "l365" > < / a > close_cmd.command = < / span > < span class = cF3 > ATAPI_CLOSE_TRACK_SESSION< / span > < span class = cF0 > > > < / span > < span class = cFE > 8< / span > < span class = cF0 > ;
< a name = "l366" > < / a > close_cmd.code = close_field.u8[< / span > < span class = cFE > 1< / span > < span class = cF0 > ];
< a name = "l367" > < / a > close_cmd.track_num = < / span > < span class = cF5 > EndianU16< / span > < span class = cF0 > (track);
< a name = "l368" > < / a > < / span > < span class = cF5 > MemCopy< / span > < span class = cF0 > (& cmd_table-> acmd, & close_cmd, < / span > < span class = cF1 > sizeof< / span > < span class = cF7 > (< / span > < span class = cF9 > CAtapiCloseCmd< / span > < span class = cF7 > )< / span > < span class = cF0 > );
2021-08-15 07:23:46 +01:00
< a name = "l369" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l370" > < / 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 = "l371" > < / 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 = "l372" > < / a >
< a name = "l373" > < / a > < / span > < span class = cF1 > try< / span > < span class = cF0 >
< a name = "l374" > < / a > < / span > < span class = cFD > AHCIPortCmdWait< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
< a name = "l375" > < / a > < / span > < span class = cF1 > catch< / span > < span class = cF0 >
< a name = "l376" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l377" > < / a > < / span > < span class = cF5 > Fs< / span > < span class = cF0 > -> catch_except = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l378" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l379" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l380" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l381" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l382" > < / a > }
< a name = "l383" > < / a >
< a name = "l384" > < / a > < / span > < span class = cF1 > Bool< / span > < span class = cF0 > < / span > < span class = cF5 > AHCIAtapiBlank< / span > < span class = cF0 > (< / span > < span class = cF9 > CBlkDev< / span > < span class = cF0 > *bd, < / span > < span class = cF1 > Bool< / span > < span class = cF0 > minimal=< / span > < span class = cF3 > TRUE< / span > < span class = cF0 > )
< a name = "l385" > < / a > { < / span > < span class = cF2 > // Blank a disc. If minimal set FALSE, entire disc is blanked.< / span > < span class = cF0 >
< a name = "l386" > < / a > < / span > < span class = cF9 > CPortCmdTable< / span > < span class = cF0 > *cmd_table;
< a name = "l387" > < / a > < / span > < span class = cF9 > CFisH2D< / span > < span class = cF0 > *cmd_fis;
< a name = "l388" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port = bd-> ahci_port;
< a name = "l389" > < / 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 = "l390" > < / 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 = "l391" > < / a >
< a name = "l392" > < / 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 = "l393" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l394" > < / 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 = "l395" > < / a > < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l396" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l397" > < / a >
< a name = "l398" > < / 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 > );
2021-08-15 07:23:46 +01:00
< a name = "l399" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l400" > < / a > cmd_table = cmd_header-> cmd_table_base;
< a name = "l401" > < / 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 = "l402" > < / a >
< a name = "l403" > < / a > cmd_fis = cmd_table-> cmd_fis;
< a name = "l404" > < / a >
< a name = "l405" > < / a > cmd_fis-> type = < / span > < span class = cF3 > FISt_H2D< / span > < span class = cF0 > ;
< a name = "l406" > < / 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 = "l407" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_PACKET< / span > < span class = cF0 > ;
< a name = "l408" > < / a > cmd_table-> acmd[< / span > < span class = cFE > 0< / span > < span class = cF0 > ] = < / span > < span class = cF3 > ATAPI_BLANK< / span > < span class = cF0 > > > < / span > < span class = cFE > 8< / span > < span class = cF0 > ;
< a name = "l409" > < / a > cmd_table-> acmd[< / span > < span class = cFE > 1< / span > < span class = cF0 > ] = minimal;
2021-07-26 20:29:49 +01:00
< a name = "l410" > < / a >
2021-08-16 05:52:03 +01:00
< 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 >
2021-08-02 21:40:05 +01:00
< a name = "l421" > < / a >
2021-08-16 05:52:03 +01:00
< 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 = cF1 > Bool< / span > < span class = cF0 > < / span > < span class = cFD > AHCIAtapiModeWriteSelect< / span > < span class = cF0 > (< / span > < span class = cF9 > CBlkDev< / span > < span class = cF0 > *bd)
< a name = "l426" > < / a > { < / span > < span class = cF2 > // Set ATAPI drive write configuration.< / span > < span class = cF0 >
< a name = "l427" > < / a > < / span > < span class = cF9 > CPortCmdTable< / span > < span class = cF0 > *cmd_table;
< a name = "l428" > < / a > < / span > < span class = cF9 > CFisH2D< / span > < span class = cF0 > *cmd_fis;
< a name = "l429" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port = bd-> ahci_port;
< a name = "l430" > < / 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 = "l431" > < / 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 = "l432" > < / a > < / span > < span class = cF9 > CAtapiModeWriteList< / span > < span class = cF0 > *mode_list;
< a name = "l433" > < / a >
< a name = "l434" > < / 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 = "l435" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l436" > < / 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 = "l437" > < / a > < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l438" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l439" > < / a >
< a name = "l440" > < / a > mode_list = < / span > < span class = cF5 > CAlloc< / span > < span class = cF0 > (< / span > < span class = cF1 > sizeof< / span > < span class = cF7 > (< / span > < span class = cF9 > CAtapiModeWriteList< / span > < span class = cF7 > )< / span > < span class = cF0 > , < / span > < span class = cFB > sys_task< / span > < span class = cF0 > -> code_heap);
< a name = "l441" > < / a > mode_list-> page.code = < / span > < span class = cFE > 0x05< / span > < span class = cF0 > ; < / span > < span class = cF2 > // Write Parameters mode page code< / span > < span class = cF0 >
< a name = "l442" > < / a > mode_list-> page.length = < / span > < span class = cFE > 0x32< / span > < span class = cF0 > ; < / span > < span class = cF2 > // 0x32 indicates no support for Vendor Specific field.< / span > < span class = cF0 >
< a name = "l443" > < / a > mode_list-> page.type = < / span > < span class = cFE > 0x00< / span > < span class = cF0 > ; < / span > < span class = cF2 > // Packet/Incremental mode< / span > < span class = cF0 >
< a name = "l444" > < / a > mode_list-> page.mode = < / span > < span class = cFE > 4< / span > < span class = cF0 > | < / span > < span class = cFE > 1< / span > < span class = cF0 > < < < / span > < span class = cFE > 5< / span > < span class = cF0 > ; < / span > < span class = cF2 > // Set CD Track Mode, set Fixed Packet Size bit< / span > < span class = cF0 >
< a name = "l445" > < / a > mode_list-> page.block_type = < / span > < span class = cFE > 8< / span > < span class = cF0 > ; < / span > < span class = cF2 > // Mode 1: 2048-size blocks of data< / span > < span class = cF0 >
< a name = "l446" > < / a > mode_list-> page.packet_size = < / span > < span class = cF5 > EndianU32< / span > < span class = cF0 > (< / span > < span class = cFE > 16< / span > < span class = cF0 > );< / span > < span class = cF2 > // Number of User Data Blocks per Fixed Packet. DVD media default: 16.< / span > < span class = cF0 >
< a name = "l447" > < / a >
< a name = "l448" > < / 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 > );
2021-08-15 07:23:46 +01:00
< a name = "l449" > < / a >
2021-08-16 05:52:03 +01:00
< 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 = mode_list;
< a name = "l454" > < / a > cmd_table-> prdt[< / span > < span class = cFE > 0< / span > < span class = cF0 > ].data_byte_count = < / span > < span class = cF1 > sizeof< / span > < span class = cF0 > (< / span > < span class = cF9 > CAtapiModeWriteList< / span > < span class = cF0 > ) - < / span > < span class = cFE > 1< / span > < span class = cF0 > ; < / span > < span class = cF2 > // zero based, size of mode write 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 > cmd_fis-> feature_low= < / span > < span class = cFE > 0x01< / span > < span class = cF0 > ; < / span > < span class = cF2 > // Core Feature, 'mandatory'< / 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 > cmd_table-> acmd[< / span > < span class = cFE > 0< / span > < span class = cF0 > ] = < / span > < span class = cF3 > ATAPI_MODE_SELECT< / span > < span class = cF0 > > > < / span > < span class = cFE > 8< / span > < span class = cF0 > ;
2021-08-15 07:23:46 +01:00
< a name = "l464" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l465" > < / 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 = "l466" > < / 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 = "l467" > < / a >
< a name = "l468" > < / a > < / span > < span class = cF1 > try< / span > < span class = cF0 >
< a name = "l469" > < / a > < / span > < span class = cFD > AHCIPortCmdWait< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
< a name = "l470" > < / a > < / span > < span class = cF1 > catch< / span > < span class = cF0 >
< a name = "l471" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l472" > < / a > < / span > < span class = cF5 > Fs< / span > < span class = cF0 > -> catch_except = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l473" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l474" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l475" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l476" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l477" > < / a > }
< a name = "l478" > < / a >
< a name = "l479" > < / 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 = "l480" > < / a > {
< a name = "l481" > < / a > < / span > < span class = cF9 > CPortCmdTable< / span > < span class = cF0 > *cmd_table;
< a name = "l482" > < / a > < / span > < span class = cF9 > CFisH2D< / span > < span class = cF0 > *cmd_fis;
< a name = "l483" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port = bd-> ahci_port;
< a name = "l484" > < / 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 = "l485" > < / 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 = "l486" > < / a >
< a name = "l487" > < / 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 = "l488" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l489" > < / 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 = "l490" > < / a > < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l491" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l492" > < / a >
< a name = "l493" > < / 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 > );
2021-08-15 07:23:46 +01:00
< a name = "l494" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l495" > < / a > cmd_table = cmd_header-> cmd_table_base;
< a name = "l496" > < / 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 = "l497" > < / a >
< a name = "l498" > < / a > cmd_fis = cmd_table-> cmd_fis;
< a name = "l499" > < / a >
< a name = "l500" > < / a > cmd_fis-> type = < / span > < span class = cF3 > FISt_H2D< / span > < span class = cF0 > ;
< a name = "l501" > < / 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 = "l502" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_PACKET< / span > < span class = cF0 > ;
< a name = "l503" > < / 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 = "l504" > < / a > cmd_table-> acmd[< / span > < span class = cFE > 4< / span > < span class = cF0 > ] = < / span > < span class = cF1 > start< / span > < span class = cF0 > ;
2021-08-15 07:23:46 +01:00
< a name = "l505" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l506" > < / 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 = "l507" > < / 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 = "l508" > < / a >
< a name = "l509" > < / a > < / span > < span class = cF1 > try< / span > < span class = cF0 >
< a name = "l510" > < / a > < / span > < span class = cFD > AHCIPortCmdWait< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
< a name = "l511" > < / a > < / span > < span class = cF1 > catch< / span > < span class = cF0 >
< a name = "l512" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l513" > < / a > < / span > < span class = cF5 > Fs< / span > < span class = cF0 > -> catch_except = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l514" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l515" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l516" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l517" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l518" > < / a > }
< a name = "l519" > < / a >
< a name = "l520" > < / 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 = "l521" > < / a > { < / span > < span class = cF2 > // returns whether disc tray was successfully ejected.< / span > < span class = cF0 >
< a name = "l522" > < / a > < / span > < span class = cF1 > try< / span > < span class = cF0 >
< a name = "l523" > < / 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 = "l524" > < / a > < / span > < span class = cF1 > catch< / span > < span class = cF0 >
< a name = "l525" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l526" > < / a > < / span > < span class = cF5 > Fs< / span > < span class = cF0 > -> catch_except = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l527" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l528" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l529" > < / a > }
< a name = "l530" > < / a >
< a name = "l531" > < / 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 = "l532" > < / a > { < / span > < span class = cF2 > // returns whether disc tray was successfully closed & disc loaded.< / span > < span class = cF0 >
< a name = "l533" > < / a > < / span > < span class = cF1 > try< / span > < span class = cF0 >
< a name = "l534" > < / 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 = "l535" > < / a > < / span > < span class = cF1 > catch< / span > < span class = cF0 >
< a name = "l536" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l537" > < / a > < / span > < span class = cF5 > Fs< / span > < span class = cF0 > -> catch_except = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l538" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l539" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l540" > < / a > }
< a name = "l541" > < / a >
< a name = "l542" > < / 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 = "l543" > < / 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 = "l544" > < / a > < / span > < span class = cF9 > CPortCmdTable< / span > < span class = cF0 > *cmd_table;
< a name = "l545" > < / a > < / span > < span class = cF9 > CFisH2D< / span > < span class = cF0 > *cmd_fis;
< a name = "l546" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port = bd-> ahci_port;
< a name = "l547" > < / 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 = "l548" > < / 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 = "l549" > < / a > < / span > < span class = cF9 > U16< / span > < span class = cF0 > *dev_id_record;
< a name = "l550" > < / a >
< a name = "l551" > < / a > port-> interrupt_status = port-> interrupt_status; < / span > < span class = cF2 > //TODO: Why?< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l552" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l553" > < / 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 = "l554" > < / 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);
2021-08-14 06:36:19 +01:00
< a name = "l555" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l556" > < / a > cmd_table = cmd_header-> cmd_table_base;
< a name = "l557" > < / 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 = "l558" > < / a >
< a name = "l559" > < / a > < / span > < span class = cF2 > //Set up single PRD< / span > < span class = cF0 >
< a name = "l560" > < / a > cmd_table-> prdt[< / span > < span class = cFE > 0< / span > < span class = cF0 > ].data_base = dev_id_record;
< a name = "l561" > < / 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 = "l562" > < / 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 = "l563" > < / 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 >
2021-08-15 07:23:46 +01:00
< a name = "l564" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l565" > < / a > < / span > < span class = cF2 > //Setup command FIS< / span > < span class = cF0 >
< a name = "l566" > < / a > cmd_fis = cmd_table-> cmd_fis;
2021-08-15 07:23:46 +01:00
< a name = "l567" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l568" > < / a > cmd_fis-> type = < / span > < span class = cF3 > FISt_H2D< / span > < span class = cF0 > ;
< a name = "l569" > < / 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 = "l570" > < / a >
< a name = "l571" > < / 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 = "l572" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_IDENTIFY_PACKET< / span > < span class = cF0 > ;
< a name = "l573" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l574" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_IDENTIFY< / span > < span class = cF0 > ;
< a name = "l575" > < / a >
< a name = "l576" > < / 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 >
2021-08-14 06:36:19 +01:00
< a name = "l577" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l578" > < / a > < / span > < span class = cF2 > //Wait on previous command to complete.< / span > < span class = cF0 >
< a name = "l579" > < / 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 > );
2021-08-15 07:23:46 +01:00
< a name = "l580" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l581" > < / 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 = "l582" > < / a > < / span > < span class = cFD > AHCIPortCmdWait< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
2021-08-15 07:23:46 +01:00
< a name = "l583" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l584" > < / a > < / span > < span class = cF5 > Free< / span > < span class = cF0 > (bd-> dev_id_record);
< a name = "l585" > < / a > bd-> dev_id_record = dev_id_record;
< a name = "l586" > < / a >
< a name = "l587" > < / 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 = "l588" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l589" > < / a > bd-> max_blk = < / span > < span class = cFD > AHCILBA48CapacityGet< / span > < span class = cF0 > (dev_id_record);
2021-10-08 07:06:11 +01:00
< a name = "l590" > < / 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 > ;
2021-08-16 05:52:03 +01:00
< a name = "l591" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l592" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l593" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l594" > < / a > bd-> max_blk = < / span > < span class = cFD > AHCIAtapiCapacityGet< / span > < span class = cF0 > (bd);
2021-10-08 07:06:11 +01:00
< a name = "l595" > < / 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 > ;
2021-08-16 05:52:03 +01:00
< a name = "l596" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l597" > < / a > }
< a name = "l598" > < / a >
< a name = "l599" > < / 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 = "l600" > < / a > {< / span > < span class = cF2 > //Make sure buffer is accessible by HBA controller.< / span > < span class = cF0 >
< a name = "l601" > < / 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 = "l602" > < / a > < / span > < span class = cF2 > //MAlloc provides U64-aligned addresses, and can allocate in the code heap ( < 4GB ).< / span > < span class = cF0 >
< a name = "l603" > < / 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 = "l604" > < / 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 = "l605" > < / 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 = "l606" > < / a > < / span > < span class = cF2 > //< / span > < span class = cF0 > < / span > < span class = cF2 > " Aligning buffer under 32-bit range\n" ;< / span > < span class = cF0 >
2021-08-14 06:36:19 +01:00
< a name = "l607" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l608" > < / a > < / span > < span class = cF5 > Free< / span > < span class = cF0 > (bd-> prd_buf);
< a name = "l609" > < / 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 = "l610" > < / a >
< a name = "l611" > < / a > < / span > < span class = cF5 > Bts< / span > < span class = cF0 > (& bd-> flags, < / span > < span class = cF3 > BDf_INTERNAL_BUF< / span > < span class = cF0 > );
2021-08-15 07:23:46 +01:00
< a name = "l612" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l613" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (write)
< a name = "l614" > < / a > < / span > < span class = cF5 > MemCopy< / span > < span class = cF0 > (bd-> prd_buf, user_buf, buf_size);
< a name = "l615" > < / a >
< a name = "l616" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > bd-> prd_buf;
< a name = "l617" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l618" > < / a > < / span > < span class = cF5 > Btr< / span > < span class = cF0 > (& bd-> flags, < / span > < span class = cF3 > BDF_INTERNAL_BUF< / span > < span class = cF0 > );
2021-08-15 07:23:46 +01:00
< a name = "l619" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l620" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > user_buf;
< a name = "l621" > < / a > }
< a name = "l622" > < / a >
< a name = "l623" > < / 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 = "l624" > < / 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 = "l625" > < / a > < / span > < span class = cF2 > //Don't use this, use the AHCIAtaBlksRead and AHCIAtaBlksWrite functions.< / span > < span class = cF0 >
< a name = "l626" > < / a > < / span > < span class = cF9 > CPortCmdTable< / span > < span class = cF0 > *cmd_table;
< a name = "l627" > < / a > < / span > < span class = cF9 > CFisH2D< / span > < span class = cF0 > *cmd_fis;
< a name = "l628" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port = bd-> ahci_port;
< a name = "l629" > < / 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 = "l630" > < / 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 = "l631" > < / a > < / span > < span class = cF1 > U8< / span > < span class = cF0 > *internal_buf_tmp, *internal_buf;
< a name = "l632" > < / a > < / span > < span class = cF1 > Bool< / span > < span class = cF0 > unlock;
< a name = "l633" > < / a >
< a name = "l634" > < / 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 = "l635" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l636" > < / 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 = "l637" > < / a > < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l638" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l639" > < / a >
< a name = "l640" > < / 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 = "l641" > < / 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 = "l642" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l643" > < / 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 = "l644" > < / a > < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l645" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l646" > < / a >
< a name = "l647" > < / a > unlock = < / span > < span class = cF5 > BlkDevLock< / span > < span class = cF0 > (bd);
< a name = "l648" > < / a >
< a name = "l649" > < / a > < / span > < span class = cF2 > //Determine buffer size and PRDT length.< / span > < span class = cF0 >
< a name = "l650" > < / a > buf_size = buf_size_tmp = count * < / span > < span class = cF3 > BLK_SIZE< / span > < span class = cF0 > ;
< a name = "l651" > < / 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 = "l652" > < / a >
< a name = "l653" > < / 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 = "l654" > < / 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 = "l655" > < / 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 = "l656" > < / a >
< a name = "l657" > < / a > cmd_header-> prdt_len = prdt_len; < / span > < span class = cF2 > //Set PRD table length in cmd header.< / span > < span class = cF0 >
< a name = "l658" > < / a > < / span > < span class = cF2 > //Set 'write' bit depending on 'write' argument.< / span > < span class = cF0 >
< a name = "l659" > < / 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);
2021-08-15 07:23:46 +01:00
< a name = "l660" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l661" > < / a > internal_buf = internal_buf_tmp = < / span > < span class = cFD > AHCIBufferAlign< / span > < span class = cF0 > (bd, buf, buf_size, write);
< a name = "l662" > < / 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 = "l663" > < / a >
< a name = "l664" > < / 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 = "l665" > < / a >
< a name = "l666" > < / 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 = "l667" > < / a > cmd_table = cmd_header-> cmd_table_base;
< a name = "l668" > < / 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 = "l669" > < / a >
< a name = "l670" > < / a > < / span > < span class = cF2 > //Create 'prdt_len' amount of PRD entries in the command table< / span > < span class = cF0 >
< a name = "l671" > < / 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 = "l672" > < / 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 = "l673" > < / 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 = "l674" > < / a > byte_count = < / span > < span class = cF3 > AHCI_PRD_MAX_BYTES< / span > < span class = cF0 > ;
< a name = "l675" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l676" > < / a > byte_count = buf_size_tmp;
2021-08-15 07:23:46 +01:00
< a name = "l677" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l678" > < / 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 = "l679" > < / 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 = "l680" > < / a >
< a name = "l681" > < / a > cmd_table-> prdt[i].data_base = internal_buf_tmp;
< a name = "l682" > < / 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 = "l683" > < / a > buf_size_tmp -= byte_count;
< a name = "l684" > < / a > internal_buf_tmp += byte_count;
< a name = "l685" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l686" > < / a > < / span > < span class = cF2 > //Setup the command FIS.< / span > < span class = cF0 >
< a name = "l687" > < / a > cmd_fis = cmd_table-> cmd_fis;
2021-08-15 07:23:46 +01:00
< a name = "l688" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l689" > < / a > cmd_fis-> type = < / span > < span class = cF3 > FISt_H2D< / span > < span class = cF0 > ;
< a name = "l690" > < / 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 = "l691" > < / a >
< a name = "l692" > < / 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 = "l693" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_WRITE_DMA_EXT< / span > < span class = cF0 > ;
< a name = "l694" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l695" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_READ_DMA_EXT< / span > < span class = cF0 > ;
< a name = "l696" > < / a >
< a name = "l697" > < / a > < / span > < span class = cF2 > //Fill in the rest of the command FIS.< / span > < span class = cF0 >
< a name = "l698" > < / a > cmd_fis-> lba0 = blk.u8[< / span > < span class = cFE > 0< / span > < span class = cF0 > ];
< a name = "l699" > < / a > cmd_fis-> lba1 = blk.u8[< / span > < span class = cFE > 1< / span > < span class = cF0 > ];
< a name = "l700" > < / a > cmd_fis-> lba2 = blk.u8[< / span > < span class = cFE > 2< / span > < span class = cF0 > ];
< a name = "l701" > < / 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 = "l702" > < / a > cmd_fis-> lba3 = blk.u8[< / span > < span class = cFE > 3< / span > < span class = cF0 > ];
< a name = "l703" > < / a > cmd_fis-> lba4 = blk.u8[< / span > < span class = cFE > 4< / span > < span class = cF0 > ];
< a name = "l704" > < / a > cmd_fis-> lba5 = blk.u8[< / span > < span class = cFE > 5< / span > < span class = cF0 > ];
< a name = "l705" > < / a > cmd_fis-> count = count;
< a name = "l706" > < / a >
< a name = "l707" > < / a > < / span > < span class = cF2 > //Wait on previous command to complete.< / span > < span class = cF0 >
< a name = "l708" > < / 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 = "l709" > < / a > < / span > < span class = cF2 > //Issue the command.< / span > < span class = cF0 >
< a name = "l710" > < / a > < / span > < span class = cF5 > Bts< / span > < span class = cF0 > (& port-> cmd_issue, cmd_slot);
< a name = "l711" > < / a > < / span > < span class = cF2 > //Wait on command to finish.< / span > < span class = cF0 >
< a name = "l712" > < / a > < / span > < span class = cFD > AHCIPortCmdWait< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
< a name = "l713" > < / a >
< a name = "l714" > < / 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 = "l715" > < / 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 = "l716" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l717" > < / a > < / span > < span class = cF2 > //< / span > < span class = cF0 > < / span > < span class = cF2 > " Writing back internal buffer\n" ;< / span > < span class = cF0 >
< a name = "l718" > < / a > < / span > < span class = cF5 > MemCopy< / span > < span class = cF0 > (buf, internal_buf, buf_size);
< a name = "l719" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l720" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l721" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (unlock)
< a name = "l722" > < / a > < / span > < span class = cF5 > BlkDevUnlock< / span > < span class = cF0 > (bd);
2021-08-15 07:23:46 +01:00
< a name = "l723" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l724" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > cmd_header-> prd_byte_count;
< a name = "l725" > < / a > }
< a name = "l726" > < / a >
< a name = "l727" > < / 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 = "l728" > < / 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 = "l729" > < / a > < / span > < span class = cF9 > I64< / span > < span class = cF0 > byte_count = < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
< a name = "l730" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (!count)
< a name = "l731" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
< a name = "l732" > < / 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 = "l733" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l734" > < / 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 = "l735" > < / 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 = "l736" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l737" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l738" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l739" > < / 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 = "l740" > < / 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 = "l741" > < / 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 = "l742" > < / a > {
< a name = "l743" > < / 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 = "l744" > < / a > count -= < / span > < span class = cF3 > AHCI_PRDT_MAX_BLOCKS< / span > < span class = cF0 > ;
< a name = "l745" > < / a > blk += < / span > < span class = cF3 > AHCI_PRDT_MAX_BLOCKS< / span > < span class = cF0 > ;
< a name = "l746" > < / 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 = "l747" > < / 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 = "l748" > < / a > }
< a name = "l749" > < / 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 = "l750" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l751" > < / a >
< a name = "l752" > < / 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 > ;
2021-08-15 07:23:46 +01:00
< a name = "l753" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l754" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > byte_count;
< a name = "l755" > < / a > }
< a name = "l756" > < / a >
< a name = "l757" > < / 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 = "l758" > < / 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 = "l759" > < / a > < / span > < span class = cF9 > I64< / span > < span class = cF0 > byte_count = < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
< a name = "l760" > < / a >
< a name = "l761" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (!count)
< a name = "l762" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
< a name = "l763" > < / 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 = "l764" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l765" > < / 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 = "l766" > < / 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 = "l767" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l768" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l769" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l770" > < / 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 = "l771" > < / 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 = "l772" > < / 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 = "l773" > < / a > {
< a name = "l774" > < / 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 = "l775" > < / a > count -= < / span > < span class = cF3 > AHCI_PRDT_MAX_BLOCKS< / span > < span class = cF0 > ;
< a name = "l776" > < / a > blk += < / span > < span class = cF3 > AHCI_PRDT_MAX_BLOCKS< / span > < span class = cF0 > ;
< a name = "l777" > < / 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 = "l778" > < / 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 = "l779" > < / a > }
< a name = "l780" > < / 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 = "l781" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l782" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l783" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > byte_count;
< a name = "l784" > < / a > }
< a name = "l785" > < / a >
< a name = "l786" > < / 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 = "l787" > < / 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 = "l788" > < / a > < / span > < span class = cF9 > CPortCmdTable< / span > < span class = cF0 > *cmd_table;
< a name = "l789" > < / a > < / span > < span class = cF9 > CFisH2D< / span > < span class = cF0 > *cmd_fis;
< a name = "l790" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port = bd-> ahci_port;
< a name = "l791" > < / 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 = "l792" > < / 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 = "l793" > < / a > < / span > < span class = cF1 > U8< / span > < span class = cF0 > *internal_buf, *internal_buf_tmp;
< a name = "l794" > < / a > < / span > < span class = cF9 > CAtapiReadCmd< / span > < span class = cF0 > read_cmd;
< a name = "l795" > < / a > < / span > < span class = cF1 > Bool< / span > < span class = cF0 > unlock;
< a name = "l796" > < / a >
< a name = "l797" > < / 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 = "l798" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l799" > < / 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 = "l800" > < / a > < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l801" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l802" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (count < < / span > < span class = cFE > 1< / span > < span class = cF0 > )
< a name = "l803" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
2021-08-15 07:23:46 +01:00
< a name = "l804" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l805" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (< / span > < span class = cF1 > lock< / span > < span class = cF0 > )
< a name = "l806" > < / a > unlock = < / span > < span class = cF5 > BlkDevLock< / span > < span class = cF0 > (bd);
2021-08-15 07:23:46 +01:00
< a name = "l807" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l808" > < / a > buf_size = buf_size_tmp = count * < / span > < span class = cF3 > DVD_BLK_SIZE< / span > < span class = cF0 > ;
< a name = "l809" > < / 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 = "l810" > < / a >
< a name = "l811" > < / 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 = "l812" > < / 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 = "l813" > < / 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 = "l814" > < / a >
< a name = "l815" > < / a > cmd_header-> prdt_len = prdt_len;
2021-08-15 07:23:46 +01:00
< a name = "l816" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l817" > < / 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 = "l818" > < / 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 = "l819" > < / a >
< a name = "l820" > < / 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 = "l821" > < / a >
< a name = "l822" > < / 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 >
2021-08-15 07:23:46 +01:00
< a name = "l823" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l824" > < / a > cmd_table = cmd_header-> cmd_table_base;
< a name = "l825" > < / 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 = "l826" > < / a >
< a name = "l827" > < / 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 = "l828" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l829" > < / 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 = "l830" > < / a > byte_count = < / span > < span class = cF3 > AHCI_PRD_MAX_BYTES< / span > < span class = cF0 > ;
< a name = "l831" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l832" > < / a > byte_count = buf_size_tmp;
< a name = "l833" > < / a >
< a name = "l834" > < / 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 = "l835" > < / 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 = "l836" > < / a > cmd_table-> prdt[i].data_base = internal_buf_tmp;
< a name = "l837" > < / 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 = "l838" > < / a >
< a name = "l839" > < / a > buf_size_tmp -= byte_count;
< a name = "l840" > < / a > internal_buf_tmp += byte_count;
< a name = "l841" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l842" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l843" > < / a > cmd_fis = cmd_table-> cmd_fis;
< a name = "l844" > < / 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 > );
2021-08-15 07:23:46 +01:00
< a name = "l845" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l846" > < / a > cmd_fis-> type = < / span > < span class = cF3 > FISt_H2D< / span > < span class = cF0 > ;
< a name = "l847" > < / 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 >
2021-08-15 07:23:46 +01:00
< a name = "l848" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l849" > < / 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 = "l850" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_PACKET< / span > < span class = cF0 > ;
< a name = "l851" > < / a >
< a name = "l852" > < / 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 = "l853" > < / 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 = "l854" > < / a > read_cmd.lba = < / span > < span class = cF5 > EndianU32< / span > < span class = cF0 > (blk);
< a name = "l855" > < / a > read_cmd.count = < / span > < span class = cF5 > EndianU32< / span > < span class = cF0 > (count);
< a name = "l856" > < / 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 = "l857" > < / a >
< a name = "l858" > < / a > cmd_fis-> count = count; < / span > < span class = cF2 > //Necessary?< / span > < span class = cF0 >
< a name = "l859" > < / a >
< a name = "l860" > < / 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 > );
2021-08-15 07:23:46 +01:00
< a name = "l861" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l862" > < / a > < / span > < span class = cF5 > Bts< / span > < span class = cF0 > (& port-> cmd_issue, cmd_slot);
< a name = "l863" > < / a > < / span > < span class = cFD > AHCIPortCmdWait< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
< a name = "l864" > < / a >
< a name = "l865" > < / 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 = "l866" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l867" > < / a > < / span > < span class = cF2 > //< / span > < span class = cF0 > < / span > < span class = cF2 > " Writing back internal buffer\n" ;< / span > < span class = cF0 >
< a name = "l868" > < / a > < / span > < span class = cF5 > MemCopy< / span > < span class = cF0 > (buf, internal_buf, buf_size);
< a name = "l869" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l870" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l871" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (< / span > < span class = cF1 > lock< / span > < span class = cF0 > & & unlock)
< a name = "l872" > < / a > < / span > < span class = cF5 > BlkDevUnlock< / span > < span class = cF0 > (bd);
2021-08-15 07:23:46 +01:00
< a name = "l873" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l874" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > cmd_header-> prd_byte_count;
< a name = "l875" > < / a > }
< a name = "l876" > < / a >
< a name = "l877" > < / 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 = "l878" > < / a > { < / span > < span class = cF2 > // Write blocks to a disc. (AHCIAtapiModeWriteSet must be called first.)< / span > < span class = cF0 >
< a name = "l879" > < / a > < / span > < span class = cF9 > CPortCmdTable< / span > < span class = cF0 > *cmd_table;
< a name = "l880" > < / a > < / span > < span class = cF9 > CFisH2D< / span > < span class = cF0 > *cmd_fis;
< a name = "l881" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port = bd-> ahci_port;
< a name = "l882" > < / a > < / span > < span class = cF9 > I64< / span > < span class = cF0 > i, byte_count, buf_size, buf_size_tmp, prdt_len, cmd_slot;
< a name = "l883" > < / a > < / span > < span class = cF9 > CPortCmdHeader< / span > < span class = cF0 > *cmd_header;
< a name = "l884" > < / a > < / span > < span class = cF1 > U8< / span > < span class = cF0 > *internal_buf, *internal_buf_tmp;
< a name = "l885" > < / a > < / span > < span class = cF9 > CAtapiWriteCmd< / span > < span class = cF0 > write_cmd;
< a name = "l886" > < / a > < / span > < span class = cF1 > Bool< / span > < span class = cF0 > unlock;
< a name = "l887" > < / a >
< a name = "l888" > < / 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 = "l889" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l890" > < / 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 = "l891" > < / a > < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l892" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l893" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (count < < / span > < span class = cFE > 1< / span > < span class = cF0 > )
< a name = "l894" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
2021-08-14 06:36:19 +01:00
< a name = "l895" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l896" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (< / span > < span class = cF1 > lock< / span > < span class = cF0 > )
< a name = "l897" > < / a > unlock = < / span > < span class = cF5 > BlkDevLock< / span > < span class = cF0 > (bd);
2021-08-15 07:23:46 +01:00
< a name = "l898" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l899" > < / a > cmd_slot = < / span > < span class = cFD > AHCIPortCmdSlotGet< / span > < span class = cF0 > (bd-> port_num);
< a name = "l900" > < / a > cmd_header = < / span > < span class = cFD > AHCIPortActiveHeaderGet< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
2021-08-15 07:23:46 +01:00
< a name = "l901" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l902" > < / a > buf_size = buf_size_tmp = count * < / span > < span class = cF3 > DVD_BLK_SIZE< / span > < span class = cF0 > ;
< a name = "l903" > < / 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 = "l904" > < / a >
< a name = "l905" > < / a > cmd_header-> prdt_len = prdt_len;
< a name = "l906" > < / a >
< a name = "l907" > < / a > internal_buf = internal_buf_tmp = < / span > < span class = cFD > AHCIBufferAlign< / span > < span class = cF0 > (bd, buf, buf_size, < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > );
< a name = "l908" > < / a >
< a name = "l909" > < / 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 > );
2021-08-15 07:23:46 +01:00
< a name = "l910" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l911" > < / 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 = "l912" > < / 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 >
2021-08-14 06:36:19 +01:00
< a name = "l913" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l914" > < / a > cmd_table = cmd_header-> cmd_table_base;
< a name = "l915" > < / 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 = "l916" > < / a >
< a name = "l917" > < / 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 = "l918" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l919" > < / 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 = "l920" > < / a > byte_count = < / span > < span class = cF3 > AHCI_PRD_MAX_BYTES< / span > < span class = cF0 > ;
< a name = "l921" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l922" > < / a > byte_count = buf_size_tmp;
< a name = "l923" > < / a > cmd_table-> prdt[i].data_base = internal_buf_tmp;
< a name = "l924" > < / 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 = "l925" > < / a >
< a name = "l926" > < / a > buf_size_tmp -= byte_count;
< a name = "l927" > < / a > internal_buf_tmp += byte_count;
< a name = "l928" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l929" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l930" > < / a > cmd_fis = cmd_table-> cmd_fis;
< a name = "l931" > < / 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 > );
2021-08-14 06:36:19 +01:00
< a name = "l932" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l933" > < / a > cmd_fis-> type = < / span > < span class = cF3 > FISt_H2D< / span > < span class = cF0 > ;
< a name = "l934" > < / 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 = "l935" > < / a >
< a name = "l936" > < / a > cmd_fis-> command = < / span > < span class = cF3 > ATA_PACKET< / span > < span class = cF0 > ;
< a name = "l937" > < / a >
< a name = "l938" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (count > < / span > < span class = cF3 > U16_MAX< / span > < span class = cF0 > ) < / span > < span class = cF5 > throw< / span > < span class = cF0 > (< / span > < span class = cF6 > 'AHCI'< / span > < span class = cF0 > );
< a name = "l939" > < / a > < / span > < span class = cF5 > MemSet< / span > < span class = cF0 > (& write_cmd, < / span > < span class = cFE > 0< / span > < span class = cF0 > , < / span > < span class = cF1 > sizeof< / span > < span class = cF7 > (< / span > < span class = cF9 > CAtapiWriteCmd< / span > < span class = cF7 > )< / span > < span class = cF0 > );
< a name = "l940" > < / a > write_cmd.command = < / span > < span class = cF3 > ATAPI_WRITE< / span > < span class = cF0 > > > < / span > < span class = cFE > 8< / span > < span class = cF0 > ;
< a name = "l941" > < / a > write_cmd.lba = < / span > < span class = cF5 > EndianU32< / span > < span class = cF0 > (blk);
< a name = "l942" > < / a > write_cmd.count = < / span > < span class = cF5 > EndianU16< / span > < span class = cF0 > (count);
< a name = "l943" > < / a > < / span > < span class = cF5 > MemCopy< / span > < span class = cF0 > (& cmd_table-> acmd, & write_cmd, < / span > < span class = cF1 > sizeof< / span > < span class = cF7 > (< / span > < span class = cF9 > CAtapiWriteCmd< / span > < span class = cF7 > )< / span > < span class = cF0 > );
< a name = "l944" > < / a >
< a name = "l945" > < / 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 > );
2021-08-15 07:23:46 +01:00
< a name = "l946" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l947" > < / a > < / span > < span class = cF5 > Bts< / span > < span class = cF0 > (& port-> cmd_issue, cmd_slot);
< a name = "l948" > < / a > < / span > < span class = cFD > AHCIPortCmdWait< / span > < span class = cF0 > (bd-> port_num, cmd_slot);
< a name = "l949" > < / a >
< a name = "l950" > < / 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 = "l951" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l952" > < / a > < / span > < span class = cF2 > //< / span > < span class = cF0 > < / span > < span class = cF2 > " Writing back internal buffer\n" ;< / span > < span class = cF0 >
< a name = "l953" > < / a > < / span > < span class = cF5 > MemCopy< / span > < span class = cF0 > (buf, internal_buf, buf_size);
< a name = "l954" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l955" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l956" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (< / span > < span class = cF1 > lock< / span > < span class = cF0 > & & unlock)
< a name = "l957" > < / a > < / span > < span class = cF5 > BlkDevUnlock< / span > < span class = cF0 > (bd);
2021-08-14 06:36:19 +01:00
< a name = "l958" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l959" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > cmd_header-> prd_byte_count;
< a name = "l960" > < / a > }
< a name = "l961" > < / a >
< a name = "l962" > < / 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 = "l963" > < / 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 = "l964" > < / a > < / span > < span class = cF9 > CPortCmdHeader< / span > < span class = cF0 > *cmd_header;
< a name = "l965" > < / a > < / span > < span class = cF9 > I64< / span > < span class = cF0 > i;
2021-08-15 07:23:46 +01:00
< a name = "l966" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l967" > < / 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 = "l968" > < / 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 > );
2021-08-14 06:36:19 +01:00
< a name = "l969" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l970" > < / 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 = "l971" > < / 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 > );
2021-08-14 06:36:19 +01:00
< a name = "l972" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l973" > < / 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 = "l974" > < / 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 > );
2021-08-14 06:36:19 +01:00
< a name = "l975" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l976" > < / a > bd-> ahci_port = port;
< a name = "l977" > < / a > bd-> port_num = port_num;
2021-08-15 07:23:46 +01:00
< a name = "l978" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l979" > < / a > < / span > < span class = cF5 > AHCIPortReset< / span > < span class = cF0 > (port_num);
< a name = "l980" > < / a > < / span > < span class = cFD > AHCIPortCmdStart< / span > < span class = cF0 > (port_num);
< a name = "l981" > < / a >
< a name = "l982" > < / 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 = "l983" > < / 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 = "l984" > < / 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 = "l985" > < / a > < / span > < span class = cFD > AHCIPortCmdStop< / span > < span class = cF0 > (port_num);
< a name = "l986" > < / a >
< a name = "l987" > < / a > < / span > < span class = cF2 > //'1K-byte' align as per SATA spec.< / span > < span class = cF0 >
< a name = "l988" > < / 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 = "l989" > < / a > port-> cmd_list_base_upper = < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
< a name = "l990" > < / a >
< a name = "l991" > < / 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 = "l992" > < / 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 = "l993" > < / a > port-> fis_base_upper = < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
< a name = "l994" > < / a >
< a name = "l995" > < / 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 = "l996" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l997" > < / a > cmd_header = & port-> cmd_list_base(< / span > < span class = cF9 > CPortCmdHeader< / span > < span class = cF0 > *)[i];
< a name = "l998" > < / 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 = "l999" > < / 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 = "l1000" > < / a >
< a name = "l1001" > < / 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 = "l1002" > < / 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 = "l1003" > < / a > cmd_header-> cmd_table_base_upper = < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
< a name = "l1004" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l1005" > < / a > < / span > < span class = cFD > AHCIPortCmdStart< / span > < span class = cF0 > (port_num);
< a name = "l1006" > < / a > < / span > < span class = cFD > AHCIPortIdentify< / span > < span class = cF0 > (bd);
< a name = "l1007" > < / a > }
< a name = "l1008" > < / a >
< a name = "l1009" > < / 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 = "l1010" > < / a > {
< a name = "l1011" > < / a > < / span > < span class = cF1 > Bool< / span > < span class = cF0 > unlock, okay = < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l1012" > < / a > < / span > < span class = cF9 > CPortCmdHeader< / span > < span class = cF0 > *cmd_header;
< a name = "l1013" > < / a > < / span > < span class = cF9 > I64< / span > < span class = cF0 > i;
2021-08-13 23:46:15 +01:00
< a name = "l1014" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l1015" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (!bd-> ahci_port)
< a name = "l1016" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l1017" > < / a >
< a name = "l1018" > < / a > unlock = < / span > < span class = cF5 > BlkDevLock< / span > < span class = cF0 > (bd);
< a name = "l1019" > < / a >
< a name = "l1020" > < / a > < / span > < span class = cF2 > // if we re-init a port, keep memory from leaking.< / span > < span class = cF0 >
< a name = "l1021" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (bd-> ahci_port-> cmd_list_base)
< a name = "l1022" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1023" > < / 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 = "l1024" > < / a > {
< a name = "l1025" > < / a > cmd_header = & bd-> ahci_port-> cmd_list_base(< / span > < span class = cF9 > CPortCmdHeader< / span > < span class = cF0 > *)[i];
< a name = "l1026" > < / a > < / span > < span class = cF5 > Free< / span > < span class = cF0 > (cmd_header-> cmd_table_base);
< a name = "l1027" > < / a > }
< a name = "l1028" > < / a > < / span > < span class = cF5 > Free< / span > < span class = cF0 > (bd-> ahci_port-> cmd_list_base);
< a name = "l1029" > < / a > < / span > < span class = cF5 > Free< / span > < span class = cF0 > (bd-> ahci_port-> fis_base);
< a name = "l1030" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l1031" > < / a >
< a name = "l1032" > < / a > < / span > < span class = cF2 > // try to init the port, catch if fails.< / span > < span class = cF0 >
< a name = "l1033" > < / a > < / span > < span class = cF1 > try< / span > < span class = cF0 >
< a name = "l1034" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1035" > < / a > < / span > < span class = cF5 > AHCIPortInit< / span > < span class = cF0 > (bd, bd-> ahci_port, bd-> port_num);
< a name = "l1036" > < / a >
< a name = "l1037" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (bd-> type == < / span > < span class = cF3 > BDT_ATAPI< / span > < span class = cF0 > )
< a name = "l1038" > < / a > okay = < / span > < span class = cF5 > AHCIAtapiStartStop< / span > < span class = cF0 > (bd, < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > );
< a name = "l1039" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l1040" > < / a > okay = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l1041" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l1042" > < / a > < / span > < span class = cF1 > catch< / span > < span class = cF0 >
< a name = "l1043" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1044" > < / a > < / span > < span class = cF5 > Fs< / span > < span class = cF0 > -> catch_except = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l1045" > < / a > okay = < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l1046" > < / a > < / span > < span class = cF3 > ST_WARN_ST< / span > < span class = cF0 > < / span > < span class = cF6 > " AHCIAtaInit" < / span > < span class = cF0 > ;
< a name = "l1047" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-15 07:23:46 +01:00
< a name = "l1048" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l1049" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (unlock)
< a name = "l1050" > < / a > < / span > < span class = cF5 > BlkDevUnlock< / span > < span class = cF0 > (bd);
2021-08-15 07:23:46 +01:00
< a name = "l1051" > < / a >
2021-08-16 05:52:03 +01:00
< a name = "l1052" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > okay;
< a name = "l1053" > < / a > }
< a name = "l1054" > < / a >
< a name = "l1055" > < / a > < / span > < span class = cF1 > U0< / span > < span class = cF0 > < / span > < span class = cF5 > AHCIHbaReset< / span > < span class = cF0 > ()
< a name = "l1056" > < / a > {
< a name = "l1057" > < / 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 = "l1058" > < / 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 = "l1059" > < / 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 = "l1060" > < / a > }
< a name = "l1061" > < / a >
< a name = "l1062" > < / a > < / span > < span class = cF1 > U0< / span > < span class = cF0 > < / span > < span class = cFD > AHCIInit< / span > < span class = cF0 > ()
< a name = "l1063" > < / a > {
< a name = "l1064" > < / a > < / span > < span class = cF9 > CAHCIHba< / span > < span class = cF0 > *hba;
< a name = "l1065" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port;
2021-10-08 07:06:11 +01:00
< a name = "l1066" > < / a > < / span > < span class = cF9 > I64< / span > < span class = cF0 > i, bdf;
2021-08-16 05:52:03 +01:00
< a name = "l1067" > < / a >
2021-12-04 10:03:02 +00:00
< a name = "l1068" > < / a > < / span > < span class = cF6 > " ______________________\n" < / span > < span class = cF0 > ;
2021-08-16 05:52:03 +01:00
< a name = "l1069" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1070" > < / a > 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 = "l1071" > < / a >
< a name = "l1072" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (bdf == -< / span > < span class = cFE > 1< / span > < span class = cF0 > )
< a name = "l1073" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1074" > < / a > < / span > < span class = cF6 > " AHCI: No AHCI controller found.\n" < / span > < span class = cF0 > ;
< a name = "l1075" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > ;
< a name = "l1076" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l1077" > < / a >
< a name = "l1078" > < / a > < / span > < span class = cF6 > " AHCI: Controller found\n" < / span > < span class = cF0 > ;
< a name = "l1079" > < / 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 = "l1080" > < / a > < / span > < span class = cFB > blkdev< / span > < span class = cF0 > .ahci_hba = hba;
< a name = "l1081" > < / a >
< a name = "l1082" > < / a >
< a name = "l1083" > < / 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 = "l1084" > < / a > < / span > < span class = cF6 > " AHCI: GHC.AE set\n" < / span > < span class = cF0 > ;
< a name = "l1085" > < / a >
< a name = "l1086" > < / a > < / span > < span class = cF2 > //Transferring ownership from BIOS if supported.< / span > < span class = cF0 >
< a name = "l1087" > < / 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 = "l1088" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1089" > < / 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 = "l1090" > < / a > < / span > < span class = cF6 > " AHCI: Transferring ownership from BIOS\n" < / span > < span class = cF0 > ;
2021-08-17 07:07:34 +01:00
< a name = "l1091" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1092" > < / 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 = "l1093" > < / a >
< a name = "l1094" > < / a > < / span > < span class = cF5 > Sleep< / span > < span class = cF0 > (< / span > < span class = cFE > 25< / span > < span class = cF0 > );
< a name = "l1095" > < / 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 = "l1096" > < / a > < / span > < span class = cF5 > Sleep< / span > < span class = cF0 > (< / span > < span class = cFE > 2000< / span > < span class = cF0 > );
< a name = "l1097" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l1098" > < / a >
< a name = "l1099" > < / 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 = "l1100" > < / 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 = "l1101" > < / a >
< a name = "l1102" > < / 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 = "l1103" > < / a > < / span > < span class = cF7 > {< / 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-> ports_implemented, i< / span > < span class = cF7 > )< / span > < span class = cF0 > )
< a name = "l1105" > < / a > {< / span > < span class = cF2 > //Make ports idle?< / span > < span class = cF0 >
< a name = "l1106" > < / a > port = & hba-> ports[i];
< a name = "l1107" > < / a > < / span > < span class = cF6 > " AHCI: Port %2d signature 0x%08X " < / span > < span class = cF0 > , i, port-> signature;
< a name = "l1108" > < / 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 = "l1109" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1110" > < / 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 = "l1111" > < / a > {
< a name = "l1112" > < / 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 = "l1113" > < / a > < / span > < span class = cF6 > " ATAPI drive\n" < / span > < span class = cF0 > ;
< a name = "l1114" > < / a > }
< a name = "l1115" > < / 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 = "l1116" > < / a > < / span > < span class = cF6 > " ATA drive\n" < / span > < span class = cF0 > ;
< a name = "l1117" > < / a >
< a name = "l1118" > < / 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 = "l1119" > < / a > {
< a name = "l1120" > < / a > < / span > < span class = cF6 > " AHCI: Port %2d not idle, stopping port\n" < / span > < span class = cF0 > , i;
< a name = "l1121" > < / a > < / span > < span class = cFD > AHCIPortCmdStop< / span > < span class = cF0 > (i);
< a name = "l1122" > < / a > }
< a name = "l1123" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l1124" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l1125" > < / a > < / span > < span class = cF6 > " Unknown\n" < / span > < span class = cF0 > ;
< a name = "l1126" > < / a > }
< a name = "l1127" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-12-04 10:03:02 +00:00
< a name = "l1128" > < / a > < / span > < span class = cF6 > " ______________________\n\n" < / span > < span class = cF0 > ;
2021-10-08 07:06:11 +01:00
< a name = "l1129" > < / a > }
< a name = "l1130" > < / a >
< a name = "l1131" > < / 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 = "l1132" > < / a > {
< a name = "l1133" > < / a > < / span > < span class = cF9 > I64< / span > < span class = cF0 > i;
< a name = "l1134" > < / a > < / span > < span class = cF9 > CAHCIPort< / span > < span class = cF0 > *port;
< a name = "l1135" > < / 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 = "l1136" > < / a > < / span > < span class = cF9 > CKernel< / span > < span class = cF0 > *kernel;
< a name = "l1137" > < / a >
2021-12-04 10:03:02 +00:00
< a name = "l1138" > < / a > < / span > < span class = cF6 > " ______________________\n" < / span > < span class = cF0 > ;
2021-10-08 07:06:11 +01:00
< a name = "l1139" > < / a >
< a name = "l1140" > < / 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 = "l1141" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1142" > < / 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 = "l1143" > < / a > {
< a name = "l1144" > < / a > port = & < / span > < span class = cFB > blkdev< / span > < span class = cF0 > .ahci_hba-> ports[i];
< a name = "l1145" > < / a > < / span > < span class = cF6 > " AHCI: BootDVDProbeAll: Saw port at %2d with signature 0x%0X\n" < / span > < span class = cF0 > , i, port-> signature;
2021-08-16 05:52:03 +01:00
< a name = "l1146" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1147" > < / 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 = "l1148" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1149" > < / a > < / span > < span class = cF6 > " AHCI: Probing ATAPI drive at port %d\n" < / span > < span class = cF0 > , i;
2021-08-16 05:52:03 +01:00
< a name = "l1150" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1151" > < / a > < / span > < span class = cF1 > try< / span > < span class = cF0 >
< a name = "l1152" > < / a > {
< a name = "l1153" > < / a > < / span > < span class = cF5 > AHCIPortInit< / span > < span class = cF0 > (bd, port, i);
< a name = "l1154" > < / a >
< a name = "l1155" > < / 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 = "l1156" > < / a > }
< a name = "l1157" > < / a > < / span > < span class = cF1 > catch< / span > < span class = cF0 >
< a name = "l1158" > < / a > {
< a name = "l1159" > < / a > < / span > < span class = cF5 > Fs< / span > < span class = cF0 > -> catch_except = < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l1160" > < / a > < / span > < span class = cF6 > " AHCI: Error at Port %d" < / span > < span class = cF0 > , i;
< a name = "l1161" > < / a > }
< a name = "l1162" > < / a >
< a name = "l1163" > < / 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 = "l1164" > < / a >
< a name = "l1165" > < / 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 = "l1166" > < / a > {
< a name = "l1167" > < / 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;
2021-12-04 10:03:02 +00:00
< a name = "l1168" > < / a > < / span > < span class = cF6 > " ______________________\n" < / span > < span class = cF0 > ;
2021-10-08 07:06:11 +01:00
< a name = "l1169" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l1170" > < / a > }
< a name = "l1171" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l1172" > < / a > < / span > < span class = cF6 > " AHCI: Did not find matching sys_compile_time on Port %d\n" < / span > < span class = cF0 > , i;
< a name = "l1173" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l1174" > < / a > }
< a name = "l1175" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
2021-08-17 07:07:34 +01:00
< a name = "l1176" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1177" > < / 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 = "l1178" > < / a >
< a name = "l1179" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l1180" > < / a > }
< a name = "l1181" > < / a >
< a name = "l1182" > < / 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 = "l1183" > < / a > {
< a name = "l1184" > < / a > < / span > < span class = cF9 > CBlkDev< / span > < span class = cF0 > *bd = drive-> bd;
< a name = "l1185" > < / 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 = "l1186" > < / 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 = "l1187" > < / 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 = "l1188" > < / a >
< a name = "l1189" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (bd-> type == < / span > < span class = cF3 > BDT_ATAPI< / span > < span class = cF0 > )
< a name = "l1190" > < / a > < / span > < span class = cF7 > {< / span > < span class = cF0 >
< a name = "l1191" > < / a > dvd_buf = < / span > < span class = cF5 > MAlloc< / span > < span class = cF0 > (l2 < < < / span > < span class = cF3 > BLK_SIZE_BITS< / span > < span class = cF0 > );
2021-08-17 07:07:34 +01:00
< a name = "l1192" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1193" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (blk < = bd-> max_reads)
< a name = "l1194" > < / a > blk2 = < / span > < span class = cFE > 0< / span > < span class = cF0 > ;
< a name = "l1195" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l1196" > < / a > blk2 = < / span > < span class = cF5 > FloorU64< / span > < span class = cF0 > (blk - bd-> max_reads, spc);
2021-08-17 07:07:34 +01:00
< a name = "l1197" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1198" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (blk2 + l2 > drive-> size + drive-> drv_offset)
< a name = "l1199" > < / a > l2 = drive-> size + drive-> drv_offset - blk2;
2021-08-17 07:07:34 +01:00
< a name = "l1200" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1201" > < / a > n = (l2 + spc - < / span > < span class = cFE > 1< / span > < span class = cF0 > ) / spc;
< a name = "l1202" > < / a >
< a name = "l1203" > < / 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 = "l1204" > < / a > < / span > < span class = cF5 > AHCIAtapiBlksRead< / span > < span class = cF0 > (bd, dvd_buf, blk2 / spc, n);
< a name = "l1205" > < / a >
< a name = "l1206" > < / 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 = "l1207" > < / a > < / span > < span class = cFD > DiskCacheAdd< / span > < span class = cF0 > (drive, dvd_buf, blk2, n * spc);
< a name = "l1208" > < / a >
< a name = "l1209" > < / 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 = "l1210" > < / a > < / span > < span class = cF5 > Free< / span > < span class = cF0 > (dvd_buf);
< a name = "l1211" > < / a >
< a name = "l1212" > < / a > < / span > < span class = cF7 > }< / span > < span class = cF0 >
< a name = "l1213" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l1214" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l1215" > < / a >
< a name = "l1216" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l1217" > < / a > }
< a name = "l1218" > < / a >
< a name = "l1219" > < / 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 = "l1220" > < / a > {
< a name = "l1221" > < / a > < / span > < span class = cF9 > CBlkDev< / span > < span class = cF0 > *bd = drive-> bd;
2021-08-17 07:07:34 +01:00
< a name = "l1222" > < / a >
2021-10-08 07:06:11 +01:00
< a name = "l1223" > < / a > < / span > < span class = cF1 > if< / span > < span class = cF0 > (bd-> type == < / span > < span class = cF3 > BDT_ATA< / span > < span class = cF0 > )
< a name = "l1224" > < / a > < / span > < span class = cF5 > AHCIAtaBlksRead< / span > < span class = cF0 > (bd, buf, blk, count);
< a name = "l1225" > < / a > < / span > < span class = cF1 > else< / span > < span class = cF0 >
< a name = "l1226" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > FALSE< / span > < span class = cF0 > ;
< a name = "l1227" > < / a >
< a name = "l1228" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l1229" > < / a > }
< a name = "l1230" > < / a >
< a name = "l1231" > < / 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 = "l1232" > < / a > {
< a name = "l1233" > < / a > < / span > < span class = cF9 > CBlkDev< / span > < span class = cF0 > *bd = drive-> bd;
< a name = "l1234" > < / a >
< a name = "l1235" > < / a > < / span > < span class = cF5 > AHCIAtaBlksWrite< / span > < span class = cF0 > (bd, buf, blk, count);
< a name = "l1236" > < / a >
< a name = "l1237" > < / a > < / span > < span class = cFB > blkdev< / span > < span class = cF0 > .write_count += count;
< a name = "l1238" > < / a >
< a name = "l1239" > < / a > < / span > < span class = cF1 > return< / span > < span class = cF0 > < / span > < span class = cF3 > TRUE< / span > < span class = cF0 > ;
< a name = "l1240" > < / a > }
2021-08-02 21:40:05 +01:00
< / span > < / pre > < / body >
2021-07-03 05:07:57 +01:00
< / html >
