ata_8c-source.html

avr应用测试程序

00406     lba = lba >> 8;
00407     cyl = (int) ( lba & 0x0000ffff );
00408     lba = lba >> 16;
00409     head = ( (int) ( lba & 0x0fL ) ) | ATA_HEAD_USE_LBA;
00410 
00411     temp = ataWriteSectorsCHS( Drive, head, cyl, sect, numsectors, Buffer );
00412 
00413     <span class="keywordflow">if</span>(temp)
00414         ataDiskErr();
00415     <span class="keywordflow">return</span> temp;
00416 }                                   
00417 
00418 
00419 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataReadSectors(   <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Drive, 
00420                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">long</span> lba,
00421                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> numsectors,
00422                                 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> *Buffer)
00423 {
00424     <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> cyl, head, sect;
00425     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00426 
00427     <span class="comment">// check if drive supports native LBA mode</span>
00428     <span class="keywordflow">if</span>(ataDriveInfo.LBAsupport)
00429     {
00430         <span class="comment">// drive supports using native LBA</span>
00431         temp = ataReadSectorsLBA(Drive, lba, numsectors, Buffer);
00432     }
00433     <span class="keywordflow">else</span>
00434     {
00435         <span class="comment">// drive required CHS access</span>
00436 <span class="preprocessor">        #ifdef DEBUG_ATA</span>
00437 <span class="preprocessor"></span>            <span class="comment">// do this defore destroying lba</span>
00438             <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"ATA LBA for CHS read: "</span>);
00439             <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"LBA="</span>); <a class="code" href="group__rprintf.html#ga9">rprintfu32</a>(lba); <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" "</span>);
00440 <span class="preprocessor">        #endif</span>
00441 <span class="preprocessor"></span>
00442         <span class="comment">// convert LBA to pseudo CHS</span>
00443         <span class="comment">// remember to offset the sector count by one</span>
00444         sect = (u08) (lba % ataDriveInfo.sectors)+1;
00445         lba = lba / ataDriveInfo.sectors;
00446         head = (u08) (lba % ataDriveInfo.heads);
00447         lba = lba / ataDriveInfo.heads;
00448         cyl = (u16) lba;
00449 
00450 <span class="preprocessor">        #ifdef DEBUG_ATA</span>
00451 <span class="preprocessor"></span>            <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"C:H:S="</span>);
00452             <a class="code" href="group__rprintf.html#ga8">rprintfu16</a>(cyl); <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">":"</span>);
00453             <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(head); <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">":"</span>);
00454             <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(sect); <a class="code" href="group__rprintf.html#ga5">rprintfCRLF</a>();
00455 <span class="preprocessor">        #endif</span>
00456 <span class="preprocessor"></span>
00457         temp = ataReadSectorsCHS( Drive, head, cyl, sect, numsectors, Buffer );
00458     }
00459 
00460     <span class="keywordflow">if</span>(temp)
00461         ataDiskErr();
00462     <span class="keywordflow">return</span> temp;
00463 }
00464 
00465 
00466 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataWriteSectors(<span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Drive, 
00467                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">long</span> lba,
00468                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> numsectors,
00469                                 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> *Buffer)
00470 {
00471     <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> cyl, head, sect;
00472     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00473 
00474     <span class="comment">// check if drive supports native LBA mode</span>
00475     <span class="keywordflow">if</span>(ataDriveInfo.LBAsupport)
00476     {
00477         <span class="comment">// drive supports using native LBA</span>
00478         temp = ataWriteSectorsLBA(Drive, lba, numsectors, Buffer);
00479     }
00480     <span class="keywordflow">else</span>
00481     {
00482         <span class="comment">// drive required CHS access</span>
00483 <span class="preprocessor">        #ifdef DEBUG_ATA</span>
00484 <span class="preprocessor"></span>            <span class="comment">// do this defore destroying lba</span>
00485             <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"ATA LBA for CHS write: "</span>);
00486             <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"LBA="</span>); <a class="code" href="group__rprintf.html#ga9">rprintfu32</a>(lba); <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" "</span>);
00487 <span class="preprocessor">        #endif</span>
00488 <span class="preprocessor"></span>
00489         <span class="comment">// convert LBA to pseudo CHS</span>
00490         <span class="comment">// remember to offset the sector count by one</span>
00491         sect = (u08) (lba % ataDriveInfo.sectors)+1;
00492         lba = lba / ataDriveInfo.sectors;
00493         head = (u08) (lba % ataDriveInfo.heads);
00494         lba = lba / ataDriveInfo.heads;
00495         cyl = (u16) lba;
00496 
00497 <span class="preprocessor">        #ifdef DEBUG_ATA</span>
00498 <span class="preprocessor"></span>            <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"C:H:S="</span>);
00499             <a class="code" href="group__rprintf.html#ga8">rprintfu16</a>(cyl); <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">":"</span>);
00500             <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(head); <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">":"</span>);
00501             <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(sect); <a class="code" href="group__rprintf.html#ga5">rprintfCRLF</a>();
00502 <span class="preprocessor">        #endif</span>
00503 <span class="preprocessor"></span>
00504         temp = ataWriteSectorsCHS( Drive, head, cyl, sect, numsectors, Buffer );
00505     }
00506 
00507     <span class="keywordflow">if</span>(temp)
00508         ataDiskErr();
00509     <span class="keywordflow">return</span> temp;
00510 }                                   
00511 
00512 <span class="keywordtype">void</span> ataDriveSelect(u08 DriveNo)
00513 {
00514     ataWriteByte(ATA_REG_HDDEVSEL, 0xA0+(DriveNo ? 0x10:00)); <span class="comment">// Drive selection</span>
00515 }
00516  
00517 <span class="comment">//----------------------------------------------------------------------------</span>
00518 <span class="comment">// Set drive mode (STANDBY, IDLE)</span>
00519 <span class="comment">//----------------------------------------------------------------------------</span>
00520 <span class="comment">/*#define STANDBY 0</span>
00521 <span class="comment">#define IDLE    1</span>
00522 <span class="comment">#define SLEEP   2 </span>
00523 <span class="comment">*/</span> 
00524 
00525 <span class="comment">/*</span>
00526 <span class="comment">unsigned char SetMode(unsigned char DriveNo, unsigned char Mode, unsigned char PwrDown) </span>
00527 <span class="comment">{</span>
00528 <span class="comment">  WriteBYTE(CMD, 6, 0xA0 + (DriveNo ? 0x10:0x00)); // Select drive</span>
00529 <span class="comment">  WriteBYTE(CMD, 2, (PwrDown ? 0x01:0x00)); // Enable automatic power down</span>
00530 <span class="comment">  switch (Mode) </span>
00531 <span class="comment">  {</span>
00532 <span class="comment">    case STANDBY: WriteBYTE(CMD,7, 0xE2); break;</span>
00533 <span class="comment">    case IDLE:    WriteBYTE(CMD,7, 0xE3); break;</span>
00534 <span class="comment">    // NOTE: To recover from sleep, either issue a soft or hardware reset !</span>
00535 <span class="comment">    // (But not on all drives, f.ex seagate ST3655A it's not nessecary to reset</span>
00536 <span class="comment">    // but only to go in Idle mode, But on a Conner CFA170A it's nessecary with</span>
00537 <span class="comment">    // a reset)</span>
00538 <span class="comment">    case SLEEP:   WriteBYTE(CMD,7, 0xE6); break;</span>
00539 <span class="comment">  }</span>
00540 <span class="comment">  Timer10mSec=10000;</span>
00541 <span class="comment">  while ((ReadBYTE(CMD,7) &amp; 0xC0)!=0x40 &amp;&amp; Timer10mSec); // Wait for DRDY &amp; NOT BUSY </span>
00542 <span class="comment">  if (Timer10mSec==0) return 0xFF;                       //   or timeout</span>
00543 <span class="comment"> </span>
00544 <span class="comment">  // Return the error register...</span>
00545 <span class="comment">  return ReadBYTE(CMD, 1);</span>
00546 <span class="comment">}</span>
00547 <span class="comment"></span>
00548 <span class="comment">*/</span>
00549 
00550 u08 ataReadByte(u08 reg)
00551 {
00552     <span class="keyword">register</span> u08 ret;
00553     <span class="comment">//sbi(MCUCR, SRW);          // enable RAM waitstate</span>
00554     ret = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + reg);
00555     <span class="comment">//cbi(MCUCR, SRW);          // disable RAM waitstate</span>
00556     <span class="keywordflow">return</span> ret;
00557 }
00558 
00559 <span class="keywordtype">void</span> ataWriteByte(u08 reg, u08 data)
00560 {
00561     <span class="comment">//sbi(MCUCR, SRW);          // enable RAM waitstate</span>
00562     *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + reg) = data;
00563     <span class="comment">//cbi(MCUCR, SRW);          // disable RAM waitstate</span>
00564 }
00565 
00566  
00567 <span class="keywordtype">void</span> ataShowRegisters(<span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> DriveNo) 
00568 { 
00569     ataWriteByte(ATA_REG_HDDEVSEL, 0xA0 + (DriveNo ? 0x10:0x00)); <span class="comment">// Select drive</span>
00570     
00571     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"R0: DATALOW  = 0x"</span>);   <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(ataReadByte(ATA_REG_DATAL    ));     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" \r\n"</span>);
00572     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"R1: ERROR    = 0x"</span>);   <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(ataReadByte(ATA_REG_ERROR    ));     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" \r\n"</span>);
00573     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"R2: SECT CNT = 0x"</span>);   <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(ataReadByte(ATA_REG_SECCOUNT));      <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" \r\n"</span>);
00574     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"R3: SECT NUM = 0x"</span>);   <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(ataReadByte(ATA_REG_STARTSEC));      <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" \r\n"</span>);
00575     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"R4: CYL LOW  = 0x"</span>);   <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(ataReadByte(ATA_REG_CYLLO    ));     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" \r\n"</span>);
00576     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"R5: CYL HIGH = 0x"</span>);   <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(ataReadByte(ATA_REG_CYLHI    ));     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" \r\n"</span>);
00577     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"R6: HEAD/DEV = 0x"</span>);   <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(ataReadByte(ATA_REG_HDDEVSEL));      <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" \r\n"</span>);
00578     <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"R7: CMD/STA  = 0x"</span>);   <a class="code" href="group__rprintf.html#ga7">rprintfu08</a>(ataReadByte(ATA_REG_CMDSTATUS1));    <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"\r\n"</span>);
00579 } 
00580 
00581 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataSWReset(<span class="keywordtype">void</span>)
00582 {
00583     ataWriteByte(ATA_REG_HDDEVSEL, 0x06);   <span class="comment">// SRST and nIEN bits</span>
00584     delay(10);  <span class="comment">// 10uS delay</span>
00585     ataWriteByte(ATA_REG_HDDEVSEL, 0x02);   <span class="comment">// nIEN bits</span>
00586     delay(10);  <span class="comment">// 10 uS delay</span>
00587    
00588    <span class="keywordflow">while</span>( (ataReadByte(ATA_REG_CMDSTATUS1) &amp; 0xC0) != 0x40 ); <span class="comment">// Wait for DRDY and not BSY</span>
00589     
00590     <span class="keywordflow">return</span> ataReadByte(ATA_REG_CMDSTATUS1) + ataReadByte(ATA_REG_ERROR);
00591 }
00592 
00593 <span class="comment">/*</span>
00594 <span class="comment">unsigned char ATA_Idle(unsigned char Drive)</span>
00595 <span class="comment">{</span>
00596 <span class="comment"></span>
00597 <span class="comment">  WriteBYTE(CMD, 6, 0xA0 + (Drive ? 0x10:0x00)); // Select drive</span>
00598 <span class="comment">  WriteBYTE(CMD,7, 0xE1);</span>
00599 <span class="comment"></span>
00600 <span class="comment">  while ((ReadBYTE(CMD,7) &amp; 0xC0)!=0x40); // Wait for DRDY &amp; NOT BUSY </span>
00601 <span class="comment"></span>
00602 <span class="comment">  // Return the error register...</span>
00603 <span class="comment">  return ReadBYTE(CMD, 1);</span>
00604 <span class="comment">}</span>
00605 <span class="comment">*/</span>
</pre></div><hr size="1"><address style="align: right;"><small>Generated on Sun Oct 29 03:41:06 2006 for Procyon AVRlib by&nbsp;
<a href="http://www.doxygen.org/index.html">
<img src="doxygen.png" alt="doxygen" align="middle" border="0"></a> 1.4.2 </small></address>
</body>
</html>