static __attribute__((used)) char* rcsid = "$CVSHeader$"; /* * * (c) 2004 Laurent Vivier * */ #include #include #include #include #include #include #include #include #include #include #include #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, int *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 > container->max_blocks) \ { \ fprintf(stderr, "Container overflow\n");\ return -1; \ } int emile_scsi_create_container(int fd, struct emile_container* container) { int ret; struct stat st; int id; 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, &id, &first_block, §or_size); if (ret != 0) return -1; container->unit_id = (u_int16_t)id; container->block_size = (u_int16_t)sector_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; }