265 lines
7.3 KiB
C
265 lines
7.3 KiB
C
|
|
#include "integer.h"
|
|
#include "diskio.h"
|
|
|
|
static volatile
|
|
DSTATUS Stat = STA_NOINIT; /* Disk status */
|
|
|
|
/*
|
|
|
|
sudo losetup /dev/loop0 disk00.vfat
|
|
sudo mkfs.vfat -f 2 -F 16 -v /dev/loop0
|
|
mkfs.vfat 2.11 (12 Mar 2005)
|
|
Loop device does not match a floppy size, using default hd params
|
|
/dev/loop0 has 64 heads and 32 sectors per track,
|
|
logical sector size is 512,
|
|
using 0xf8 media descriptor, with 524288 sectors;
|
|
file system has 2 16-bit FATs and 8 sectors per cluster.
|
|
FAT size is 256 sectors, and provides 65467 clusters.
|
|
Root directory contains 512 slots.
|
|
Volume ID is 4a1aab3d, no volume label.
|
|
|
|
|
|
FAT type = 2
|
|
Bytes/Cluster = 4096
|
|
Number of FATs = 2
|
|
Root DIR entries = 512
|
|
Sectors/FAT = 256
|
|
Number of clusters = 65467
|
|
FAT start (lba) = 1
|
|
DIR start (lba,clustor) = 513
|
|
Data start (lba) = 545
|
|
Ok
|
|
disk_read: sector=513 count=1 addr=0xa8009800 size=512
|
|
scan_files ret
|
|
0 files, 0 bytes.
|
|
0 folders.
|
|
261868 KB total disk space.
|
|
147456 KB available.
|
|
|
|
|
|
|
|
|
|
Disk: /dev/disk1 geometry: 993/4/63 [250368 sectors]
|
|
Signature: 0xAA55
|
|
Starting Ending
|
|
#: id cyl hd sec - cyl hd sec [ start - size]
|
|
------------------------------------------------------------------------
|
|
1: 0B 0 1 1 - 1023 254 63 [ 63 - 250299] Win95 FAT-32
|
|
2: 00 0 0 0 - 0 0 0 [ 0 - 0] unused
|
|
3: 00 0 0 0 - 0 0 0 [ 0 - 0] unused
|
|
4: 00 0 0 0 - 0 0 0 [ 0 - 0] unused
|
|
*/
|
|
|
|
/* Interface
|
|
|
|
** Scratch Buffer
|
|
|
|
addr 3 byte
|
|
size 1 byte
|
|
|
|
** Call Interface
|
|
|
|
cmd 1 byte
|
|
sector 4 bytes
|
|
count 1 byte
|
|
return 1 byte
|
|
|
|
** Commands
|
|
|
|
* disk_init
|
|
* disk_read
|
|
* disk_write
|
|
|
|
|
|
*/
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Initialize Disk Drive */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <sys/types.h>
|
|
#include <sys/stat.h>
|
|
#include <unistd.h>
|
|
#include <fcntl.h>
|
|
#include <sys/mman.h>
|
|
|
|
|
|
#define IMAGE_NAME "disk00.vfat"
|
|
|
|
int *image_addr;
|
|
|
|
DSTATUS disk_initialize (BYTE drv) {
|
|
if (drv) return STA_NOINIT; /* Supports only single drive */
|
|
|
|
Stat |= STA_NOINIT;
|
|
/* map image */
|
|
|
|
|
|
int fd = open(IMAGE_NAME, O_RDWR);
|
|
if (fd == -1) {
|
|
perror("Error opening file for writing");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
|
|
int size = lseek(fd,0,SEEK_END);
|
|
lseek(fd,0,SEEK_SET);
|
|
printf("Open Image (size %i)\n",size);
|
|
|
|
//image_addr = mmap(0,fd,)
|
|
image_addr = mmap(0, size, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0);
|
|
if (image_addr == MAP_FAILED) {
|
|
close(fd);
|
|
perror("Error mmapping the file");
|
|
exit(EXIT_FAILURE);
|
|
}
|
|
|
|
Stat &= ~STA_NOINIT; /* When device goes ready, clear STA_NOINIT */
|
|
return Stat;
|
|
}
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Return Disk Status */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
DSTATUS disk_status (BYTE drv){
|
|
if (drv) return STA_NOINIT; /* Supports only single drive */
|
|
return Stat;
|
|
}
|
|
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Read Sector(s) */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
DRESULT disk_read (
|
|
BYTE drv, /* Physical drive nmuber (0) */
|
|
BYTE *buff, /* Data buffer to store read data */
|
|
DWORD sector, /* Sector number (LBA) */
|
|
BYTE count /* Sector count (1..255) */
|
|
)
|
|
{
|
|
BYTE c, iord_l, iord_h;
|
|
if (drv || !count) return RES_PARERR;
|
|
if (Stat & STA_NOINIT) return RES_NOTRDY;
|
|
|
|
DWORD offset = sector * 512;
|
|
int size = count * 512;
|
|
|
|
printf("disk_read: sector=%li count=%i addr=%p size=%i\n",sector,count,image_addr + offset,size);
|
|
memcpy(buff,image_addr + offset,size);
|
|
//printf("%x %x %x %x\n",buff[0],buff[1],buff[2],buff[3]);
|
|
|
|
return RES_OK;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Write Sector(s) */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
#if _READONLY == 0
|
|
DRESULT disk_write (
|
|
BYTE drv, /* Physical drive nmuber (0) */
|
|
const BYTE *buff, /* Data to be written */
|
|
DWORD sector, /* Sector number (LBA) */
|
|
BYTE count /* Sector count (1..255) */
|
|
)
|
|
{
|
|
BYTE s, c, iowr_l, iowr_h;
|
|
|
|
|
|
|
|
if (drv || !count) return RES_PARERR;
|
|
if (Stat & STA_NOINIT) return RES_NOTRDY;
|
|
|
|
/* Issue Write Setor(s) command */
|
|
/*
|
|
write_ata(REG_COUNT, count);
|
|
write_ata(REG_SECTOR, (BYTE)sector);
|
|
write_ata(REG_CYLL, (BYTE)(sector >> 8));
|
|
write_ata(REG_CYLH, (BYTE)(sector >> 16));
|
|
write_ata(REG_DEV, ((BYTE)(sector >> 24) & 0x0F) | LBA);
|
|
write_ata(REG_COMMAND, CMD_WRITE);
|
|
*/
|
|
|
|
return RES_OK;
|
|
}
|
|
#endif /* _READONLY */
|
|
|
|
/*-----------------------------------------------------------------------*/
|
|
/* Miscellaneous Functions */
|
|
/*-----------------------------------------------------------------------*/
|
|
|
|
#if _USE_IOCTL != 0
|
|
DRESULT disk_ioctl (
|
|
BYTE drv, /* Physical drive nmuber (0) */
|
|
BYTE ctrl, /* Control code */
|
|
void *buff /* Buffer to send/receive data block */
|
|
)
|
|
{
|
|
BYTE n, w, ofs, dl, dh, *ptr = buff;
|
|
|
|
|
|
if (drv) return RES_PARERR;
|
|
if (Stat & STA_NOINIT) return RES_NOTRDY;
|
|
|
|
switch (ctrl) {
|
|
case GET_SECTOR_COUNT : /* Get number of sectors on the disk (DWORD) */
|
|
printf("disk_ioctl: GET_SECTOR_COUNT\n");
|
|
ofs = 60; w = 2; n = 0;
|
|
break;
|
|
|
|
case GET_SECTOR_SIZE : /* Get sectors on the disk (WORD) */
|
|
printf("disk_ioctl: GET_SECTOR_SIZE\n");
|
|
*(WORD*)buff = 512;
|
|
return RES_OK;
|
|
|
|
case GET_BLOCK_SIZE : /* Get erase block size in sectors (DWORD) */
|
|
printf("disk_ioctl: GET_BLOCK_SIZE\n");
|
|
*(DWORD*)buff = 32;
|
|
return RES_OK;
|
|
|
|
case CTRL_SYNC : /* Nothing to do */
|
|
printf("disk_ioctl: CTRL_SIZE\n");
|
|
return RES_OK;
|
|
|
|
case ATA_GET_REV : /* Get firmware revision (8 chars) */
|
|
printf("disk_ioctl: ATAL_GET_REV\n");
|
|
ofs = 23; w = 4; n = 4;
|
|
break;
|
|
|
|
case ATA_GET_MODEL : /* Get model name (40 chars) */
|
|
printf("disk_ioctl: ATAL_GET_MODEL\n");
|
|
ofs = 27; w = 20; n = 20;
|
|
break;
|
|
|
|
case ATA_GET_SN : /* Get serial number (20 chars) */
|
|
printf("disk_ioctl: ATAL_GET_SN\n");
|
|
ofs = 10; w = 10; n = 10;
|
|
break;
|
|
|
|
default:
|
|
return RES_PARERR;
|
|
}
|
|
|
|
/*
|
|
write_ata(REG_COMMAND, CMD_IDENTIFY);
|
|
if (!wait_data()) return RES_ERROR;
|
|
read_part(ptr, ofs, w);
|
|
while (n--) {
|
|
dl = *ptr; dh = *(ptr+1);
|
|
*ptr++ = dh; *ptr++ = dl;
|
|
}
|
|
*/
|
|
return RES_OK;
|
|
}
|
|
#endif /* _USE_IOCTL != 0 */
|
|
|
|
|
|
|
|
|