ata_8c-source.html

单片机的软件

00201         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH);
00202         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL);
00203         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH);
00204         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL);
00205         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH);
00206         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL);
00207         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH);
00208         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL);
00209         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH);
00210         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL);
00211         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH);
00212         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL);
00213         *Buffer++ = *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH);
00214     }
00215     <span class="comment">//cbi(MCUCR, SRW);          // disable RAM waitstate</span>
00216     
00217 }
00218 
00219 <span class="keywordtype">void</span> ataWriteDataBuffer(u08 *Buffer, u16 numBytes)
00220 {
00221     <span class="keyword">register</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00222     <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> i;
00223 
00224     <span class="comment">//sbi(MCUCR, SRW);          // enable RAM waitstate</span>
00225 
00226     <span class="comment">// write data to drive</span>
00227     <span class="keywordflow">for</span> (i=0; i&lt;(numBytes/16); i++)     
00228     {
00229         <span class="comment">// optimize by writing 16 bytes in-line before looping</span>
00230         <span class="comment">// keep byte order correct by using temp register</span>
00231         temp = *Buffer++;
00232         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH) = *Buffer++;
00233         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL) = temp;
00234         temp = *Buffer++;
00235         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH) = *Buffer++;
00236         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL) = temp;
00237         temp = *Buffer++;
00238         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH) = *Buffer++;
00239         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL) = temp;
00240         temp = *Buffer++;
00241         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH) = *Buffer++;
00242         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL) = temp;
00243         temp = *Buffer++;
00244         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH) = *Buffer++;
00245         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL) = temp;
00246         temp = *Buffer++;
00247         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH) = *Buffer++;
00248         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL) = temp;
00249         temp = *Buffer++;
00250         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH) = *Buffer++;
00251         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL) = temp;
00252         temp = *Buffer++;
00253         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAH) = *Buffer++;
00254         *((<span class="keyword">volatile</span> <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span>*) ATA_REG_BASE + ATA_REG_DATAL) = temp;
00255     }
00256     <span class="comment">//cbi(MCUCR, SRW);          // disable RAM waitstate</span>
00257 
00258 }
00259 
00260 u08 ataStatusWait(u08 mask, u08 waitStatus)
00261 {
00262     <span class="keyword">register</span> u08 status;
00263 
00264     delay(100);
00265 
00266     <span class="comment">// wait for desired status</span>
00267     <span class="keywordflow">while</span>( ((status = ataReadByte(ATA_REG_CMDSTATUS1)) &amp; mask) == waitStatus );
00268 
00269     <span class="keywordflow">return</span> status;
00270 }
00271 
00272 
00273 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataReadSectorsCHS(    <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Drive, 
00274                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Head, 
00275                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> Track,
00276                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Sector,
00277                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> numsectors,
00278                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> *Buffer)
00279 {
00280     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00281 
00282     <span class="comment">// Wait for drive to be ready</span>
00283     temp = ataStatusWait(ATA_SR_BSY, ATA_SR_BSY);
00284 
00285     <span class="comment">// Prepare parameters...</span>
00286     ataWriteByte(ATA_REG_HDDEVSEL, 0xA0+(Drive ? 0x10:00)+Head); <span class="comment">// CHS mode/Drive/Head</span>
00287     ataWriteByte(ATA_REG_CYLHI, Track&gt;&gt;8);          <span class="comment">// MSB of track</span>
00288     ataWriteByte(ATA_REG_CYLLO, Track);             <span class="comment">// LSB of track</span>
00289     ataWriteByte(ATA_REG_STARTSEC, Sector);     <span class="comment">// sector</span>
00290     ataWriteByte(ATA_REG_SECCOUNT, numsectors); <span class="comment">// # of sectors</span>
00291 
00292     <span class="comment">// Issue read sector command...</span>
00293     ataWriteByte(ATA_REG_CMDSTATUS1, 0x21);
00294 
00295     <span class="comment">// Wait for drive to be ready</span>
00296     temp = ataStatusWait(ATA_SR_BSY, ATA_SR_BSY);
00297 
00298     <span class="keywordflow">if</span> (temp &amp; ATA_SR_ERR)
00299     {
00300         <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"RD ERR\r\n"</span>);
00301         <span class="keywordflow">return</span> 1;
00302     }
00303 
00304     <span class="comment">// Wait for drive to request data transfer</span>
00305     ataStatusWait(ATA_SR_DRQ, 0);
00306 
00307     <span class="comment">// read data from drive</span>
00308     ataReadDataBuffer(Buffer, 512*numsectors);
00309 
00310     <span class="comment">// Return the error bit from the status register...</span>
00311     temp = ataReadByte(ATA_REG_CMDSTATUS1); <span class="comment">// read status register</span>
00312 
00313     <span class="keywordflow">return</span> (temp &amp; ATA_SR_ERR) ? 1:0;
00314 }
00315 
00316 
00317 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataWriteSectorsCHS(<span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Drive, 
00318                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Head, 
00319                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> Track,
00320                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Sector,
00321                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> numsectors,
00322                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> *Buffer)
00323 {
00324     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00325 
00326     <span class="comment">// Wait for drive to be ready</span>
00327     temp = ataStatusWait(ATA_SR_BSY, ATA_SR_BSY);
00328 
00329     <span class="comment">// Prepare parameters...</span>
00330     ataWriteByte(ATA_REG_HDDEVSEL, 0xA0+(Drive ? 0x10:00)+Head); <span class="comment">// CHS mode/Drive/Head</span>
00331     ataWriteByte(ATA_REG_CYLHI, Track&gt;&gt;8);          <span class="comment">// MSB of track</span>
00332     ataWriteByte(ATA_REG_CYLLO, Track);             <span class="comment">// LSB of track</span>
00333     ataWriteByte(ATA_REG_STARTSEC, Sector);     <span class="comment">// sector</span>
00334     ataWriteByte(ATA_REG_SECCOUNT, numsectors); <span class="comment">// # of sectors</span>
00335 
00336     <span class="comment">// Issue write sector command</span>
00337     ataWriteByte(ATA_REG_CMDSTATUS1, 0x31);
00338 
00339     <span class="comment">//delay(100);</span>
00340 
00341     <span class="comment">// Wait for drive to request data transfer</span>
00342     ataStatusWait(ATA_SR_DRQ, 0);
00343 
00344     <span class="comment">// write data to drive</span>
00345     ataWriteDataBuffer(Buffer, 512*numsectors);
00346     
00347     <span class="comment">// Wait for drive to finish write</span>
00348     temp = ataStatusWait(ATA_SR_BSY, ATA_SR_BSY);
00349 
00350     <span class="comment">// check for errors</span>
00351     <span class="keywordflow">if</span> (temp &amp; ATA_SR_ERR)
00352     {
00353         <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"WR ERR\r\n"</span>);
00354         <span class="keywordflow">return</span> 1;
00355     }
00356 
00357     <span class="comment">// Return the error bit from the status register...</span>
00358     <span class="keywordflow">return</span> (temp &amp; ATA_SR_ERR) ? 1:0;
00359 }
00360 
00361 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataReadSectorsLBA(    <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Drive, 
00362                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">long</span> lba,
00363                                             <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> numsectors,
00364                                     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> *Buffer)
00365 {
00366     <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> cyl, head, sect;
00367     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00368 
00369 <span class="preprocessor">#ifdef DEBUG_ATA</span>
00370 <span class="preprocessor"></span>    <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"ATA LBA read "</span>);
00371     <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>);
00372     <a class="code" href="group__rprintf.html#ga8">rprintfu16</a>(numsectors); <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" "</span>);
00373     <a class="code" href="group__rprintf.html#ga8">rprintfu16</a>((<span class="keywordtype">unsigned</span> <span class="keywordtype">int</span>)Buffer); 
00374     <a class="code" href="group__rprintf.html#ga5">rprintfCRLF</a>();
00375 <span class="preprocessor">#endif</span>
00376 <span class="preprocessor"></span>
00377     sect = (int) ( lba &amp; 0x000000ffL );
00378     lba = lba &gt;&gt; 8;
00379     cyl = (int) ( lba &amp; 0x0000ffff );
00380     lba = lba &gt;&gt; 16;
00381     head = ( (int) ( lba &amp; 0x0fL ) ) | ATA_HEAD_USE_LBA;
00382 
00383     temp = ataReadSectorsCHS( Drive, head, cyl, sect, numsectors, Buffer );
00384 
00385     <span class="keywordflow">if</span>(temp)
00386         ataDiskErr();
00387     <span class="keywordflow">return</span> temp;
00388 }
00389 
00390 <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> ataWriteSectorsLBA(   <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> Drive, 
00391                                                 <span class="keywordtype">unsigned</span> <span class="keywordtype">long</span> lba,
00392                                                 <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> numsectors,
00393                                         <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> *Buffer)
00394 {
00395     <span class="keywordtype">unsigned</span> <span class="keywordtype">int</span> cyl, head, sect;
00396     <span class="keywordtype">unsigned</span> <span class="keywordtype">char</span> temp;
00397 
00398 <span class="preprocessor">#ifdef DEBUG_ATA</span>
00399 <span class="preprocessor"></span>    <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">"ATA LBA write "</span>);
00400     <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>);
00401     <a class="code" href="group__rprintf.html#ga8">rprintfu16</a>(numsectors); <a class="code" href="group__rprintf.html#ga15">rprintfProgStrM</a>(<span class="stringliteral">" "</span>);
00402     <a class="code" href="group__rprintf.html#ga8">rprintfu16</a>((<span class="keywordtype">unsigned</span> <span class="keywordtype">int</span>)Buffer); 
00403     <a class="code" href="group__rprintf.html#ga5">rprintfCRLF</a>();
00404 <span class="preprocessor">#endif</span>
00405 <span class="preprocessor"></span>
00406     sect = (int) ( lba &amp; 0x000000ffL );
00407     lba = lba &gt;&gt; 8;