mirror of
https://github.com/vivier/EMILE.git
synced 2024-09-08 19:54:38 +00:00
184 lines
3.5 KiB
C
184 lines
3.5 KiB
C
/*
|
|
*
|
|
* (c) 2004 Laurent Vivier <LaurentVivier@wanadoo.fr>
|
|
*
|
|
*/
|
|
|
|
#include <unistd.h>
|
|
#include <sys/types.h>
|
|
#include <sys/stat.h>
|
|
#include <fcntl.h>
|
|
#include <stdio.h>
|
|
#include <sys/ioctl.h>
|
|
#include <errno.h>
|
|
#include <string.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/hdreg.h>
|
|
#include <scsi/scsi.h>
|
|
|
|
#include "libemile.h"
|
|
|
|
struct scsi_id {
|
|
int dev;
|
|
int host_unique_id;
|
|
};
|
|
|
|
static int get_scsi_path(int fd, unsigned char *host, unsigned char *channel,
|
|
unsigned char *pun, unsigned char *lun)
|
|
{
|
|
int ret;
|
|
struct scsi_id path;
|
|
|
|
ret = ioctl(fd, SCSI_IOCTL_GET_IDLUN, &path);
|
|
|
|
*host = path.dev >> 24;
|
|
*channel = path.dev >> 16;
|
|
*lun = path.dev >> 8;
|
|
*pun = path.dev;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int get_device_info(int fd, short *id, unsigned long *first_block,
|
|
int *block_size)
|
|
{
|
|
int ret;
|
|
char dev_name[16];
|
|
struct hd_geometry geom;
|
|
unsigned char host;
|
|
unsigned char channel;
|
|
unsigned char pun;
|
|
unsigned char lun;
|
|
char *driver;
|
|
int disk;
|
|
int partition;
|
|
|
|
ret = emile_scsi_get_dev(fd, &driver, &disk, &partition);
|
|
if (ret == -1)
|
|
return -1;
|
|
sprintf(dev_name, "%s%c%d", driver, disk + 'a', partition);
|
|
|
|
fd = open(dev_name, O_RDONLY);
|
|
if (fd == -1) {
|
|
fprintf(stderr, "Cannot open device %s (%s)\n", dev_name,
|
|
strerror(errno));
|
|
return -1;
|
|
}
|
|
ret = get_scsi_path(fd, &host, &channel, &pun, &lun);
|
|
*id = pun;
|
|
|
|
ret = ioctl(fd, HDIO_GETGEO, &geom);
|
|
if (ret == -1)
|
|
{
|
|
fprintf(stderr, "%s: ioctl(HDIO_GETGEO) fails: %s",
|
|
dev_name, strerror(errno));
|
|
return -1;
|
|
}
|
|
#if 0 /* BLKSSZGET is buggy on my m68k 2.2.27-pre2 kernel */
|
|
ret = ioctl(fd, BLKSSZGET, block_size);
|
|
if (ret == -1)
|
|
{
|
|
fprintf(stderr, "%s: ioctl(BLKSSZGET) fails: %s",
|
|
dev_name, strerror(errno));
|
|
return -1;
|
|
}
|
|
#else
|
|
*block_size = 512;
|
|
#endif
|
|
*first_block = geom.start;
|
|
close(fd);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#define ADD_BLOCK(a, b) \
|
|
container->blocks[current].offset = (a); \
|
|
container->blocks[current].count = (b); \
|
|
current++; \
|
|
if (current > maxblocks) \
|
|
{ \
|
|
fprintf(stderr, "Container overflow\n");\
|
|
return -1; \
|
|
}
|
|
|
|
int emile_scsi_create_container(int fd, short *unit_id,
|
|
struct emile_container* container, int maxblocks)
|
|
{
|
|
int ret;
|
|
struct stat st;
|
|
unsigned long first_block;
|
|
int sector_size;
|
|
int block_size;
|
|
int sectors_per_block;
|
|
int current;
|
|
int logical;
|
|
int physical;
|
|
int last_physical;
|
|
int zone;
|
|
int aggregate;
|
|
|
|
ret = fstat(fd, &st);
|
|
if (ret == -1) {
|
|
perror("stat()");
|
|
return -1;
|
|
}
|
|
|
|
ret = get_device_info(fd, unit_id, &first_block, §or_size);
|
|
if (ret != 0)
|
|
return -1;
|
|
|
|
container->size = st.st_size;
|
|
|
|
/* get filesystem block size */
|
|
|
|
ret = ioctl(fd, FIGETBSZ, &block_size);
|
|
if (ret != 0) {
|
|
perror("ioctl(FIGETBSZ)");
|
|
return -1;
|
|
}
|
|
|
|
sectors_per_block = block_size / sector_size;
|
|
|
|
/* get first physical block */
|
|
|
|
last_physical = 0;
|
|
ret = ioctl(fd, FIBMAP, &last_physical);
|
|
if (ret != 0) {
|
|
perror("ioctl(FIBMAP)");
|
|
return -1;
|
|
}
|
|
|
|
zone = last_physical;
|
|
aggregate = 1;
|
|
|
|
/* seek all physical blocks */
|
|
|
|
current = 0;
|
|
for (logical = 1;
|
|
logical < (st.st_size + block_size - 1) / block_size;
|
|
logical++) {
|
|
physical = logical;
|
|
ret = ioctl(fd, FIBMAP, &physical);
|
|
if (ret != 0)
|
|
break;
|
|
if (physical == last_physical + 1) {
|
|
aggregate++;
|
|
} else {
|
|
ADD_BLOCK(first_block + zone * sectors_per_block,
|
|
aggregate * sectors_per_block);
|
|
zone = physical;
|
|
aggregate = 1;
|
|
}
|
|
last_physical = physical;
|
|
}
|
|
|
|
ADD_BLOCK(first_block + zone * sectors_per_block,
|
|
aggregate * sectors_per_block);
|
|
|
|
/* end of list */
|
|
|
|
ADD_BLOCK(0, 0);
|
|
|
|
return 0;
|
|
}
|