ata_8c-source.html

方便飞利浦arm7tdmi 处理器lpc2100开发的C函数库 Procyon ARMlib-LPC2100 C-Language Function Library for Philips LPC21

00380     <span class="keywordflow">return</span> temp;
00381 }                                   
00382 
00383 
00384 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataReadSectors(   <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Drive, 
00385                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">long</span> lba,
00386                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> numsectors,
00387                                 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> *Buffer)
00388 {
00389     <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> cyl, head, sect;
00390     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00391 
00392     <span class="comment">// check if drive supports native LBA mode</span>
00393     <span class="keywordflow">if</span>(ataDriveInfo.LBAsupport)
00394     {
00395         <span class="comment">// drive supports using native LBA</span>
00396         temp = ataReadSectorsLBA(Drive, lba, numsectors, Buffer);
00397     }
00398     <span class="keywordflow">else</span>
00399     {
00400         <span class="comment">// drive required CHS access</span>
00401 <span class="preprocessor">        #ifdef DEBUG_ATA</span>
00402 <span class="preprocessor"></span>            <span class="comment">// do this defore destroying lba</span>
00403             <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"ATA LBA for CHS read: "</span>);
00404             <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"LBA="</span>); <a class="code" href="rprintf_8h.html#a15">rprintfu32</a>(lba); <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" "</span>);
00405 <span class="preprocessor">        #endif</span>
00406 <span class="preprocessor"></span>
00407         <span class="comment">// convert LBA to pseudo CHS</span>
00408         <span class="comment">// remember to offset the sector count by one</span>
00409         sect = (u08) (lba % ataDriveInfo.sectors)+1;
00410         lba = lba / ataDriveInfo.sectors;
00411         head = (u08) (lba % ataDriveInfo.heads);
00412         lba = lba / ataDriveInfo.heads;
00413         cyl = (u16) lba;
00414 
00415 <span class="preprocessor">        #ifdef DEBUG_ATA</span>
00416 <span class="preprocessor"></span>            <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"C:H:S="</span>);
00417             <a class="code" href="rprintf_8h.html#a14">rprintfu16</a>(cyl); <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">":"</span>);
00418             <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(head); <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">":"</span>);
00419             <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(sect); <a class="code" href="rprintf_8c.html#a10">rprintfCRLF</a>();
00420 <span class="preprocessor">        #endif</span>
00421 <span class="preprocessor"></span>
00422         temp = ataReadSectorsCHS( Drive, head, cyl, sect, numsectors, Buffer );
00423     }
00424 
00425     <span class="keywordflow">if</span>(temp)
00426         ataDiskErr();
00427     <span class="keywordflow">return</span> temp;
00428 }
00429 
00430 
00431 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataWriteSectors(<span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Drive, 
00432                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">long</span> lba,
00433                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> numsectors,
00434                                 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> *Buffer)
00435 {
00436     <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> cyl, head, sect;
00437     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00438 
00439     <span class="comment">// check if drive supports native LBA mode</span>
00440     <span class="keywordflow">if</span>(ataDriveInfo.LBAsupport)
00441     {
00442         <span class="comment">// drive supports using native LBA</span>
00443         temp = ataWriteSectorsLBA(Drive, lba, numsectors, Buffer);
00444     }
00445     <span class="keywordflow">else</span>
00446     {
00447         <span class="comment">// drive required CHS access</span>
00448 <span class="preprocessor">        #ifdef DEBUG_ATA</span>
00449 <span class="preprocessor"></span>            <span class="comment">// do this defore destroying lba</span>
00450             <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"ATA LBA for CHS write: "</span>);
00451             <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"LBA="</span>); <a class="code" href="rprintf_8h.html#a15">rprintfu32</a>(lba); <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" "</span>);
00452 <span class="preprocessor">        #endif</span>
00453 <span class="preprocessor"></span>
00454         <span class="comment">// convert LBA to pseudo CHS</span>
00455         <span class="comment">// remember to offset the sector count by one</span>
00456         sect = (u08) (lba % ataDriveInfo.sectors)+1;
00457         lba = lba / ataDriveInfo.sectors;
00458         head = (u08) (lba % ataDriveInfo.heads);
00459         lba = lba / ataDriveInfo.heads;
00460         cyl = (u16) lba;
00461 
00462 <span class="preprocessor">        #ifdef DEBUG_ATA</span>
00463 <span class="preprocessor"></span>            <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"C:H:S="</span>);
00464             <a class="code" href="rprintf_8h.html#a14">rprintfu16</a>(cyl); <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">":"</span>);
00465             <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(head); <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">":"</span>);
00466             <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(sect); <a class="code" href="rprintf_8c.html#a10">rprintfCRLF</a>();
00467 <span class="preprocessor">        #endif</span>
00468 <span class="preprocessor"></span>
00469         temp = ataWriteSectorsCHS( Drive, head, cyl, sect, numsectors, Buffer );
00470     }
00471 
00472     <span class="keywordflow">if</span>(temp)
00473         ataDiskErr();
00474     <span class="keywordflow">return</span> temp;
00475 }                                   
00476 
00477 <span class="keywordtype">void</span> ataDriveSelect(u08 DriveNo)
00478 {
00479     ataWriteByte(ATA_REG_HDDEVSEL, 0xA0+(DriveNo ? 0x10:00)); <span class="comment">// Drive selection</span>
00480 }
00481  
00482 <span class="comment">//----------------------------------------------------------------------------</span>
00483 <span class="comment">// Set drive mode (STANDBY, IDLE)</span>
00484 <span class="comment">//----------------------------------------------------------------------------</span>
00485 <span class="comment">/*#define STANDBY 0</span>
00486 <span class="comment">#define IDLE    1</span>
00487 <span class="comment">#define SLEEP   2 </span>
00488 <span class="comment">*/</span> 
00489 
00490 <span class="comment">/*</span>
00491 <span class="comment">unsigned char SetMode(unsigned char DriveNo, unsigned char Mode, unsigned char PwrDown) </span>
00492 <span class="comment">{</span>
00493 <span class="comment">  WriteBYTE(CMD, 6, 0xA0 + (DriveNo ? 0x10:0x00)); // Select drive</span>
00494 <span class="comment">  WriteBYTE(CMD, 2, (PwrDown ? 0x01:0x00)); // Enable automatic power down</span>
00495 <span class="comment">  switch (Mode) </span>
00496 <span class="comment">  {</span>
00497 <span class="comment">    case STANDBY: WriteBYTE(CMD,7, 0xE2); break;</span>
00498 <span class="comment">    case IDLE:    WriteBYTE(CMD,7, 0xE3); break;</span>
00499 <span class="comment">    // NOTE: To recover from sleep, either issue a soft or hardware reset !</span>
00500 <span class="comment">    // (But not on all drives, f.ex seagate ST3655A it's not nessecary to reset</span>
00501 <span class="comment">    // but only to go in Idle mode, But on a Conner CFA170A it's nessecary with</span>
00502 <span class="comment">    // a reset)</span>
00503 <span class="comment">    case SLEEP:   WriteBYTE(CMD,7, 0xE6); break;</span>
00504 <span class="comment">  }</span>
00505 <span class="comment">  Timer10mSec=10000;</span>
00506 <span class="comment">  while ((ReadBYTE(CMD,7) &amp; 0xC0)!=0x40 &amp;&amp; Timer10mSec); // Wait for DRDY &amp; NOT BUSY </span>
00507 <span class="comment">  if (Timer10mSec==0) return 0xFF;                       //   or timeout</span>
00508 <span class="comment"> </span>
00509 <span class="comment">  // Return the error register...</span>
00510 <span class="comment">  return ReadBYTE(CMD, 1);</span>
00511 <span class="comment">}</span>
00512 <span class="comment"></span>
00513 <span class="comment">*/</span>
00514 
00515 u08 ataReadByte(u16 reg)
00516 {
00517     <span class="keywordflow">return</span> membusRead(reg);
00518 }
00519 
00520 <span class="keywordtype">void</span> ataWriteByte(u16 reg, u08 data)
00521 {
00522     membusWrite(reg, data);
00523 }
00524 
00525  
00526 <span class="keywordtype">void</span> ataShowRegisters(<span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> DriveNo) 
00527 { 
00528     ataWriteByte(ATA_REG_HDDEVSEL, 0xA0 + (DriveNo ? 0x10:0x00)); <span class="comment">// Select drive</span>
00529     
00530     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"R0: DATA     = 0x"</span>);    <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(ataReadByte(ATA_REG_DATA     ));     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" \r\n"</span>);
00531     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"R1: ERROR    = 0x"</span>);    <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(ataReadByte(ATA_REG_ERROR    ));     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" \r\n"</span>);
00532     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"R2: SECT CNT = 0x"</span>);    <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(ataReadByte(ATA_REG_SECCOUNT));      <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" \r\n"</span>);
00533     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"R3: SECT NUM = 0x"</span>);    <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(ataReadByte(ATA_REG_STARTSEC));      <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" \r\n"</span>);
00534     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"R4: CYL LOW  = 0x"</span>);    <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(ataReadByte(ATA_REG_CYLLO    ));     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" \r\n"</span>);
00535     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"R5: CYL HIGH = 0x"</span>);    <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(ataReadByte(ATA_REG_CYLHI    ));     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" \r\n"</span>);
00536     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"R6: HEAD/DEV = 0x"</span>);    <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(ataReadByte(ATA_REG_HDDEVSEL));      <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">" \r\n"</span>);
00537     <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"R7: CMD/STA  = 0x"</span>);    <a class="code" href="rprintf_8h.html#a13">rprintfu08</a>(ataReadByte(ATA_REG_CMDSTATUS1));    <a class="code" href="rprintf_8h.html#a8">rprintfStr</a>(<span class="stringliteral">"\r\n"</span>);
00538 }
00539 
00540 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataSWReset(<span class="keywordtype">void</span>)
00541 {
00542     ataWriteByte(ATA_REG_HDDEVSEL, 0x06);   <span class="comment">// SRST and nIEN bits</span>
00543     delay(10);  <span class="comment">// 10uS delay</span>
00544     ataWriteByte(ATA_REG_HDDEVSEL, 0x02);   <span class="comment">// nIEN bits</span>
00545     delay(10);  <span class="comment">// 10 uS delay</span>
00546    
00547    <span class="keywordflow">while</span>( (ataReadByte(ATA_REG_CMDSTATUS1) &amp; 0xC0) != 0x40 ); <span class="comment">// Wait for DRDY and not BSY</span>
00548     
00549     <span class="keywordflow">return</span> ataReadByte(ATA_REG_CMDSTATUS1) + ataReadByte(ATA_REG_ERROR);
00550 }
00551 
00552 <span class="comment">/*</span>
00553 <span class="comment">unsigned char ATA_Idle(unsigned char Drive)</span>
00554 <span class="comment">{</span>
00555 <span class="comment"></span>
00556 <span class="comment">  WriteBYTE(CMD, 6, 0xA0 + (Drive ? 0x10:0x00)); // Select drive</span>
00557 <span class="comment">  WriteBYTE(CMD,7, 0xE1);</span>
00558 <span class="comment"></span>
00559 <span class="comment">  while ((ReadBYTE(CMD,7) &amp; 0xC0)!=0x40); // Wait for DRDY &amp; NOT BUSY </span>
00560 <span class="comment"></span>
00561 <span class="comment">  // Return the error register...</span>
00562 <span class="comment">  return ReadBYTE(CMD, 1);</span>
00563 <span class="comment">}</span>
00564 <span class="comment">*/</span>
</pre></div><hr size="1"><address style="align: right;"><small>Generated on Tue Jul 13 03:38:11 2004 for Procyon ARMlib-LPC2100 by
<a href="http://www.doxygen.org/index.html">
<img src="doxygen.png" alt="doxygen" align="middle" border=0 > 
</a>1.3.6 </small></address>
</body>
</html>