firmware/test/fat/ata-sim.c

   1 #include <stdio.h>
   2 #include <stdlib.h>
   3 #include <string.h>
   4 #include "debug.h"
   5
   6 #define BLOCK_SIZE 512
   7
   8 static FILE* file;
   9
  10 void panicf( const char *fmt, ... );
  11
  12 int ata_read_sectors(unsigned long start, int count, void* buf)
  13 {
  14     if ( count > 1 )
  15         DEBUGF("[Reading %d blocks: 0x%lx to 0x%lx]\n",
  16                count, start, start+count-1);
  17     else
  18         DEBUGF("[Reading block 0x%lx]\n", start);
  19
  20     if(fseek(file,start*BLOCK_SIZE,SEEK_SET)) {
  21         perror("fseek");
  22         return -1;
  23     }
  24     if(!fread(buf,BLOCK_SIZE,count,file)) {
  25         DEBUGF("ata_write_sectors(0x%x, 0x%x, 0x%x)\n", start, count, buf );
  26         perror("fread");
  27         panicf("Disk error\n");
  28     }
  29     return 0;
  30 }
  31
  32 int ata_write_sectors(unsigned long start, int count, void* buf)
  33 {
  34     if ( count > 1 )
  35         DEBUGF("[Writing %d blocks: 0x%lx to 0x%lx]\n",
  36                count, start, start+count-1);
  37     else
  38         DEBUGF("[Writing block 0x%lx]\n", start);
  39
  40     if (start == 0)
  41         panicf("Writing on sector 0!\n");
  42
  43     if(fseek(file,start*BLOCK_SIZE,SEEK_SET)) {
  44         perror("fseek");
  45         return -1;
  46     }
  47     if(!fwrite(buf,BLOCK_SIZE,count,file)) {
  48         DEBUGF("ata_write_sectors(0x%x, 0x%x, 0x%x)\n", start, count, buf );
  49         perror("fwrite");
  50         panicf("Disk error\n");
  51     }
  52     return 0;
  53 }
  54
  55 int ata_init(void)
  56 {
  57     char* filename = "disk.img";
  58     /* check disk size */
  59     file=fopen(filename,"rb+");
  60     if(!file) {
  61         fprintf(stderr, "read_disk() - Could not find \"%s\"\n",filename);
  62         return -1;
  63     }
  64     return 0;
  65 }
  66
  67 void ata_exit(void)
  68 {
  69     fclose(file);
  70 }