ide-floppy: remove struct idefloppy_flexible_disk_page
Signed-off-by: Borislav Petkov <bbpetkov@yahoo.de> Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com>
This commit is contained in:
parent
24a5d7033b
commit
8e81bbba72
|
@ -119,33 +119,6 @@ typedef struct idefloppy_packet_command_s {
|
|||
|
||||
#define PC_SUPPRESS_ERROR 6 /* Suppress error reporting */
|
||||
|
||||
/*
|
||||
* Flexible disk page.
|
||||
*/
|
||||
typedef struct {
|
||||
#if defined(__LITTLE_ENDIAN_BITFIELD)
|
||||
unsigned page_code :6; /* Page code - Should be 0x5 */
|
||||
unsigned reserved1_6 :1; /* Reserved */
|
||||
unsigned ps :1; /* The device is capable of saving the page */
|
||||
#elif defined(__BIG_ENDIAN_BITFIELD)
|
||||
unsigned ps :1; /* The device is capable of saving the page */
|
||||
unsigned reserved1_6 :1; /* Reserved */
|
||||
unsigned page_code :6; /* Page code - Should be 0x5 */
|
||||
#else
|
||||
#error "Bitfield endianness not defined! Check your byteorder.h"
|
||||
#endif
|
||||
u8 page_length; /* Page Length - Should be 0x1e */
|
||||
u16 transfer_rate; /* In kilobits per second */
|
||||
u8 heads, sectors; /* Number of heads, Number of sectors per track */
|
||||
u16 sector_size; /* Byes per sector */
|
||||
u16 cyls; /* Number of cylinders */
|
||||
u8 reserved10[10];
|
||||
u8 motor_delay; /* Motor off delay */
|
||||
u8 reserved21[7];
|
||||
u16 rpm; /* Rotations per minute */
|
||||
u8 reserved30[2];
|
||||
} idefloppy_flexible_disk_page_t;
|
||||
|
||||
/*
|
||||
* Format capacity
|
||||
*/
|
||||
|
@ -214,7 +187,7 @@ typedef struct ide_floppy_obj {
|
|||
/* Last format capacity */
|
||||
idefloppy_capacity_descriptor_t capacity;
|
||||
/* Copy of the flexible disk page */
|
||||
idefloppy_flexible_disk_page_t flexible_disk_page;
|
||||
u8 flexible_disk_page[32];
|
||||
/* Write protect */
|
||||
int wp;
|
||||
/* Supports format progress report */
|
||||
|
@ -1095,48 +1068,57 @@ static int idefloppy_queue_pc_tail (ide_drive_t *drive,idefloppy_pc_t *pc)
|
|||
}
|
||||
|
||||
/*
|
||||
* Look at the flexible disk page parameters. We will ignore the CHS
|
||||
* capacity parameters and use the LBA parameters instead.
|
||||
* Look at the flexible disk page parameters. We ignore the CHS capacity
|
||||
* parameters and use the LBA parameters instead.
|
||||
*/
|
||||
static int idefloppy_get_flexible_disk_page (ide_drive_t *drive)
|
||||
static int ide_floppy_get_flexible_disk_page(ide_drive_t *drive)
|
||||
{
|
||||
idefloppy_floppy_t *floppy = drive->driver_data;
|
||||
idefloppy_pc_t pc;
|
||||
idefloppy_flexible_disk_page_t *page;
|
||||
u8 *page;
|
||||
int capacity, lba_capacity;
|
||||
u16 transfer_rate, sector_size, cyls, rpm;
|
||||
u8 heads, sectors;
|
||||
|
||||
idefloppy_create_mode_sense_cmd(&pc, IDEFLOPPY_FLEXIBLE_DISK_PAGE, MODE_SENSE_CURRENT);
|
||||
if (idefloppy_queue_pc_tail(drive,&pc)) {
|
||||
printk(KERN_ERR "ide-floppy: Can't get flexible disk "
|
||||
"page parameters\n");
|
||||
idefloppy_create_mode_sense_cmd(&pc, IDEFLOPPY_FLEXIBLE_DISK_PAGE,
|
||||
MODE_SENSE_CURRENT);
|
||||
|
||||
if (idefloppy_queue_pc_tail(drive, &pc)) {
|
||||
printk(KERN_ERR "ide-floppy: Can't get flexible disk page"
|
||||
" parameters\n");
|
||||
return 1;
|
||||
}
|
||||
floppy->wp = !!(pc.buffer[3] & 0x80);
|
||||
set_disk_ro(floppy->disk, floppy->wp);
|
||||
page = (idefloppy_flexible_disk_page_t *) &pc.buffer[8];
|
||||
page = &pc.buffer[8];
|
||||
|
||||
page->transfer_rate = be16_to_cpu(page->transfer_rate);
|
||||
page->sector_size = be16_to_cpu(page->sector_size);
|
||||
page->cyls = be16_to_cpu(page->cyls);
|
||||
page->rpm = be16_to_cpu(page->rpm);
|
||||
capacity = page->cyls * page->heads * page->sectors * page->sector_size;
|
||||
if (memcmp (page, &floppy->flexible_disk_page, sizeof (idefloppy_flexible_disk_page_t)))
|
||||
transfer_rate = be16_to_cpu(*(u16 *)&pc.buffer[8 + 2]);
|
||||
sector_size = be16_to_cpu(*(u16 *)&pc.buffer[8 + 6]);
|
||||
cyls = be16_to_cpu(*(u16 *)&pc.buffer[8 + 8]);
|
||||
rpm = be16_to_cpu(*(u16 *)&pc.buffer[8 + 28]);
|
||||
heads = pc.buffer[8 + 4];
|
||||
sectors = pc.buffer[8 + 5];
|
||||
|
||||
capacity = cyls * heads * sectors * sector_size;
|
||||
|
||||
if (memcmp(page, &floppy->flexible_disk_page, 32))
|
||||
printk(KERN_INFO "%s: %dkB, %d/%d/%d CHS, %d kBps, "
|
||||
"%d sector size, %d rpm\n",
|
||||
drive->name, capacity / 1024, page->cyls,
|
||||
page->heads, page->sectors,
|
||||
page->transfer_rate / 8, page->sector_size, page->rpm);
|
||||
drive->name, capacity / 1024, cyls, heads,
|
||||
sectors, transfer_rate / 8, sector_size, rpm);
|
||||
|
||||
floppy->flexible_disk_page = *page;
|
||||
drive->bios_cyl = page->cyls;
|
||||
drive->bios_head = page->heads;
|
||||
drive->bios_sect = page->sectors;
|
||||
memcpy(&floppy->flexible_disk_page, page, 32);
|
||||
drive->bios_cyl = cyls;
|
||||
drive->bios_head = heads;
|
||||
drive->bios_sect = sectors;
|
||||
lba_capacity = floppy->blocks * floppy->block_size;
|
||||
|
||||
if (capacity < lba_capacity) {
|
||||
printk(KERN_NOTICE "%s: The disk reports a capacity of %d "
|
||||
"bytes, but the drive only handles %d\n",
|
||||
drive->name, lba_capacity, capacity);
|
||||
floppy->blocks = floppy->block_size ? capacity / floppy->block_size : 0;
|
||||
floppy->blocks = floppy->block_size ?
|
||||
capacity / floppy->block_size : 0;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
@ -1243,7 +1225,7 @@ static int idefloppy_get_capacity (ide_drive_t *drive)
|
|||
|
||||
/* Clik! disk does not support get_flexible_disk_page */
|
||||
if (!test_bit(IDEFLOPPY_CLIK_DRIVE, &floppy->flags)) {
|
||||
(void) idefloppy_get_flexible_disk_page(drive);
|
||||
(void) ide_floppy_get_flexible_disk_page(drive);
|
||||
}
|
||||
|
||||
set_capacity(floppy->disk, floppy->blocks * floppy->bs_factor);
|
||||
|
|
Loading…
Reference in New Issue
Block a user