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