68 lines
1.6 KiB
C
68 lines
1.6 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include "debug.h"
|
|
|
|
static FILE* file;
|
|
|
|
void panicf( const char *fmt, ... );
|
|
|
|
int storage_read_sectors(unsigned long start, int count, void* buf)
|
|
{
|
|
if ( count > 1 )
|
|
DEBUGF("[Reading %d blocks: 0x%lx to 0x%lx]\n",
|
|
count, start, start+count-1);
|
|
else
|
|
DEBUGF("[Reading block 0x%lx]\n", start);
|
|
|
|
if(fseek(file,start*SECTOR_SIZE,SEEK_SET)) {
|
|
perror("fseek");
|
|
return -1;
|
|
}
|
|
if(!fread(buf,SECTOR_SIZE,count,file)) {
|
|
DEBUGF("ata_write_sectors(0x%lx, 0x%x, %p)\n", start, count, buf );
|
|
perror("fread");
|
|
panicf("Disk error\n");
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int storage_write_sectors(unsigned long start, int count, void* buf)
|
|
{
|
|
if ( count > 1 )
|
|
DEBUGF("[Writing %d blocks: 0x%lx to 0x%lx]\n",
|
|
count, start, start+count-1);
|
|
else
|
|
DEBUGF("[Writing block 0x%lx]\n", start);
|
|
|
|
if (start == 0)
|
|
panicf("Writing on sector 0!\n");
|
|
|
|
if(fseek(file,start*SECTOR_SIZE,SEEK_SET)) {
|
|
perror("fseek");
|
|
return -1;
|
|
}
|
|
if(!fwrite(buf,SECTOR_SIZE,count,file)) {
|
|
DEBUGF("ata_write_sectors(0x%lx, 0x%x, %p)\n", start, count, buf );
|
|
perror("fwrite");
|
|
panicf("Disk error\n");
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
int ata_init(void)
|
|
{
|
|
char* filename = "disk.img";
|
|
/* check disk size */
|
|
file=fopen(filename,"rb+");
|
|
if(!file) {
|
|
fprintf(stderr, "read_disk() - Could not find \"%s\"\n",filename);
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void ata_exit(void)
|
|
{
|
|
fclose(file);
|
|
}
|