Считывание секторов с DVD дисков

#define SCSI_READ10    0x28
#define SEC_SIZE 2048
#define MAX_COUNT 32

BOOL ReadCDROM(UNI_ADDR *addr, unsigned LBA, unsigned count, void *buf)
    {
    UNI_SRB usrb;
    BOOL ret;
    unsigned read_now;
    void *batch;
    
    usrb.Addr=*addr;
    batch=SCSIBatchBegin(&usrb);
    if(batch==NULL)
        {
        SCSILastError=usrb.Err;
        return FALSE;
        }

    while(count>0)
        {
        if(count>MAX_COUNT)
            read_now=MAX_COUNT;
        else
            read_now=count;
        ZeroMemory(&usrb, sizeof(usrb));
        usrb.Addr=*addr;
        usrb.CDBLen=10;
        usrb.CDB[0]=SCSI_READ10;
        usrb.CDB[2]=(unsigned char)(LBA>>24);
        usrb.CDB[3]=(unsigned char)(LBA>>16);
        usrb.CDB[4]=(unsigned char)(LBA>>8);
        usrb.CDB[5]=(unsigned char)LBA;
        usrb.CDB[7]=(unsigned char)(read_now>>8);
        usrb.CDB[8]=(unsigned char)read_now;
        usrb.DataLen=read_now*SEC_SIZE;
        usrb.DataBuffer=buf;
        usrb.DataOut=0;
        usrb.SenseLen=sizeof(usrb.SenseBuffer);

        ret=SCSIBatchCmd(&usrb, batch);

        if(!ret)
            {
            SCSILastError=usrb.Err;
            break;
            }

        count-=read_now;
        LBA+=read_now;
        buf=read_now*SEC_SIZE+(unsigned char *)buf;
        }

    SCSIBatchEnd(batch);

    return ret;
    }

#define SCSI_READCDCAP    0x25

unsigned ReadCDROMCapacity(UNI_ADDR *addr)
    {
    UNI_SRB usrb;
    unsigned char buf[16];
    BOOL ret;
    unsigned LBA;
        
    ZeroMemory(&usrb, sizeof(usrb));
    usrb.Addr=*addr;
    usrb.CDBLen=10;
    usrb.CDB[0]=SCSI_READCDCAP;
    usrb.DataLen=sizeof(buf);
    usrb.DataBuffer=buf;
    usrb.DataOut=0;
    usrb.SenseLen=sizeof(usrb.SenseBuffer);

    ret=SCSICmd(&usrb);
            
    if(ret)
        LBA=(buf[0]<<24)|(buf[1]<<16)|
            (buf[2]<<8)|buf[3];
    else
        LBA=0;

    return LBA;
    }

#include <stdio.h>
#include <stdlib.h>
#include <fcntl.h>
#include <unistd.h>
#include <string.h>
#include <sys/ioctl.h>
#include <linux/cdrom.h>
#include <inttypes.h>

int read_capacity(int fd);
int read_sectors(int fd, int LBA, int count, void *buf);

int main(int argc, char *argv[])
    {
    int fd;
    int capacity;
    unsigned char buf[CD_FRAMESIZE * 1];

    if(argc != 2)
        {
        fprintf(stderr, "Call: readcd /dev/cdrom\n");
        return EXIT_FAILURE;
        }

    fd = open(argv[1], O_RDONLY | O_NONBLOCK);
    if(fd < 0)
        {
        perror(argv[1]);
        return EXIT_FAILURE;
        }

    capacity = read_capacity(fd);

    if(capacity == 0)
        return EXIT_FAILURE;

    printf("Capacity: %d sectors (%" PRIuMAX " bytes)\n", capacity, (uintmax_t)capacity * CD_FRAMESIZE);

    if(read_sectors(fd, 16, 1, buf) != 0)
        return EXIT_FAILURE;

    close(fd);

    fd = creat("sectors.dat", 0666);
    if(fd < 0)
        {
        perror("sectors.dat");
        return EXIT_FAILURE;
        }

    write(fd, buf, sizeof(buf));

    close(fd);

    printf("Volume: '%.32s'\n", buf + 0x28);

    return EXIT_SUCCESS;
    }

int read_capacity(int fd)
    {
    struct cdrom_generic_command cgc;
    struct request_sense sense;
    unsigned char buf[16];
    int LBA;

    memset(&sense, 0, sizeof(sense));

    memset(&cgc, 0, sizeof(cgc));
    cgc.cmd[0] = GPCMD_READ_CDVD_CAPACITY;
    cgc.buffer = buf;
    cgc.buflen = sizeof(buf);
    cgc.sense = &sense;
    cgc.data_direction = CGC_DATA_READ;

    if(ioctl(fd, CDROM_SEND_PACKET, &cgc) != 0)
        {
        perror("GPCMD_READ_CDVD_CAPACITY");
        return 0;
        }

    LBA = (buf[0]<<24)|(buf[1]<<16)|(buf[2]<<8)|buf[3];

    return LBA;
    }

int read_sectors(int fd, int LBA, int count, void *buf)
    {
    struct cdrom_generic_command cgc;
    struct request_sense sense;
    int ret;

    memset(&sense, 0, sizeof(sense));

    memset(&cgc, 0, sizeof(cgc));
    cgc.cmd[0] = GPCMD_READ_10;
    cgc.cmd[2] = (unsigned char)(LBA >> 24);
    cgc.cmd[3] = (unsigned char)(LBA >> 16);
    cgc.cmd[4] = (unsigned char)(LBA >> 8);
    cgc.cmd[5] = (unsigned char)LBA;
    cgc.cmd[7] = (unsigned char)(count >> 8);
    cgc.cmd[8] = (unsigned char)count;
    cgc.buffer = buf;
    cgc.buflen = count * CD_FRAMESIZE;
    cgc.sense = &sense;
    cgc.data_direction = CGC_DATA_READ;

    ret = ioctl(fd, CDROM_SEND_PACKET, &cgc);

    if(ret != 0)
        perror("GPCMD_READ_10");

    return ret;
    }