[deliverable/linux.git] / drivers / ide / ide-gd.c

#include <linux/module.h>
#include <linux/types.h>
#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/genhd.h>
#include <linux/mutex.h>
#include <linux/ide.h>
#include <linux/hdreg.h>
#include <linux/dmi.h>
#include <linux/slab.h>

#if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
#define IDE_DISK_MINORS		(1 << PARTN_BITS)
#else
#define IDE_DISK_MINORS		0
#endif

#include "ide-disk.h"
#include "ide-floppy.h"

#define IDE_GD_VERSION	"1.18"

/* module parameters */
static DEFINE_MUTEX(ide_gd_mutex);
static unsigned long debug_mask;
module_param(debug_mask, ulong, 0644);

static DEFINE_MUTEX(ide_disk_ref_mutex);

static void ide_disk_release(struct device *);

static struct ide_disk_obj *ide_disk_get(struct gendisk *disk)
{
	struct ide_disk_obj *idkp = NULL;

	mutex_lock(&ide_disk_ref_mutex);
	idkp = ide_drv_g(disk, ide_disk_obj);
	if (idkp) {
		if (ide_device_get(idkp->drive))
			idkp = NULL;
		else
			get_device(&idkp->dev);
	}
	mutex_unlock(&ide_disk_ref_mutex);
	return idkp;
}

static void ide_disk_put(struct ide_disk_obj *idkp)
{
	ide_drive_t *drive = idkp->drive;

	mutex_lock(&ide_disk_ref_mutex);
	put_device(&idkp->dev);
	ide_device_put(drive);
	mutex_unlock(&ide_disk_ref_mutex);
}

sector_t ide_gd_capacity(ide_drive_t *drive)
{
	return drive->capacity64;
}

static int ide_gd_probe(ide_drive_t *);

static void ide_gd_remove(ide_drive_t *drive)
{
	struct ide_disk_obj *idkp = drive->driver_data;
	struct gendisk *g = idkp->disk;

	ide_proc_unregister_driver(drive, idkp->driver);
	device_del(&idkp->dev);
	del_gendisk(g);
	drive->disk_ops->flush(drive);

	mutex_lock(&ide_disk_ref_mutex);
	put_device(&idkp->dev);
	mutex_unlock(&ide_disk_ref_mutex);
}

static void ide_disk_release(struct device *dev)
{
	struct ide_disk_obj *idkp = to_ide_drv(dev, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;
	struct gendisk *g = idkp->disk;

	drive->disk_ops = NULL;
	drive->driver_data = NULL;
	g->private_data = NULL;
	put_disk(g);
	kfree(idkp);
}

/*
 * On HPA drives the capacity needs to be
 * reinitialized on resume otherwise the disk
 * can not be used and a hard reset is required
 */
static void ide_gd_resume(ide_drive_t *drive)
{
	if (ata_id_hpa_enabled(drive->id))
		(void)drive->disk_ops->get_capacity(drive);
}

static const struct dmi_system_id ide_coldreboot_table[] = {
	{
		/* Acer TravelMate 66x cuts power during reboot */
		.ident   = "Acer TravelMate 660",
		.matches = {
			DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
			DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 660"),
		},
	},

	{ }	/* terminate list */
};

static void ide_gd_shutdown(ide_drive_t *drive)
{
#ifdef	CONFIG_ALPHA
	/* On Alpha, halt(8) doesn't actually turn the machine off,
	   it puts you into the sort of firmware monitor. Typically,
	   it's used to boot another kernel image, so it's not much
	   different from reboot(8). Therefore, we don't need to
	   spin down the disk in this case, especially since Alpha
	   firmware doesn't handle disks in standby mode properly.
	   On the other hand, it's reasonably safe to turn the power
	   off when the shutdown process reaches the firmware prompt,
	   as the firmware initialization takes rather long time -
	   at least 10 seconds, which should be sufficient for
	   the disk to expire its write cache. */
	if (system_state != SYSTEM_POWER_OFF) {
#else
	if (system_state == SYSTEM_RESTART &&
		!dmi_check_system(ide_coldreboot_table)) {
#endif
		drive->disk_ops->flush(drive);
		return;
	}

	printk(KERN_INFO "Shutdown: %s\n", drive->name);

	drive->gendev.bus->suspend(&drive->gendev, PMSG_SUSPEND);
}

#ifdef CONFIG_IDE_PROC_FS
static ide_proc_entry_t *ide_disk_proc_entries(ide_drive_t *drive)
{
	return (drive->media == ide_disk) ? ide_disk_proc : ide_floppy_proc;
}

static const struct ide_proc_devset *ide_disk_proc_devsets(ide_drive_t *drive)
{
	return (drive->media == ide_disk) ? ide_disk_settings
					  : ide_floppy_settings;
}
#endif

static ide_startstop_t ide_gd_do_request(ide_drive_t *drive,
					 struct request *rq, sector_t sector)
{
	return drive->disk_ops->do_request(drive, rq, sector);
}

static struct ide_driver ide_gd_driver = {
	.gen_driver = {
		.owner		= THIS_MODULE,
		.name		= "ide-gd",
		.bus		= &ide_bus_type,
	},
	.probe			= ide_gd_probe,
	.remove			= ide_gd_remove,
	.resume			= ide_gd_resume,
	.shutdown		= ide_gd_shutdown,
	.version		= IDE_GD_VERSION,
	.do_request		= ide_gd_do_request,
#ifdef CONFIG_IDE_PROC_FS
	.proc_entries		= ide_disk_proc_entries,
	.proc_devsets		= ide_disk_proc_devsets,
#endif
};

static int ide_gd_open(struct block_device *bdev, fmode_t mode)
{
	struct gendisk *disk = bdev->bd_disk;
	struct ide_disk_obj *idkp;
	ide_drive_t *drive;
	int ret = 0;

	idkp = ide_disk_get(disk);
	if (idkp == NULL)
		return -ENXIO;

	drive = idkp->drive;

	ide_debug_log(IDE_DBG_FUNC, "enter");

	idkp->openers++;

	if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
		drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
		/* Just in case */

		ret = drive->disk_ops->init_media(drive, disk);

		/*
		 * Allow O_NDELAY to open a drive without a disk, or with an
		 * unreadable disk, so that we can get the format capacity
		 * of the drive or begin the format - Sam
		 */
		if (ret && (mode & FMODE_NDELAY) == 0) {
			ret = -EIO;
			goto out_put_idkp;
		}

		if ((drive->dev_flags & IDE_DFLAG_WP) && (mode & FMODE_WRITE)) {
			ret = -EROFS;
			goto out_put_idkp;
		}

		/*
		 * Ignore the return code from door_lock,
		 * since the open() has already succeeded,
		 * and the door_lock is irrelevant at this point.
		 */
		drive->disk_ops->set_doorlock(drive, disk, 1);
		drive->dev_flags |= IDE_DFLAG_MEDIA_CHANGED;
		check_disk_change(bdev);
	} else if (drive->dev_flags & IDE_DFLAG_FORMAT_IN_PROGRESS) {
		ret = -EBUSY;
		goto out_put_idkp;
	}
	return 0;

out_put_idkp:
	idkp->openers--;
	ide_disk_put(idkp);
	return ret;
}

static int ide_gd_unlocked_open(struct block_device *bdev, fmode_t mode)
{
	int ret;

	mutex_lock(&ide_gd_mutex);
	ret = ide_gd_open(bdev, mode);
	mutex_unlock(&ide_gd_mutex);

	return ret;
}


static int ide_gd_release(struct gendisk *disk, fmode_t mode)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;

	ide_debug_log(IDE_DBG_FUNC, "enter");

	mutex_lock(&ide_gd_mutex);
	if (idkp->openers == 1)
		drive->disk_ops->flush(drive);

	if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
		drive->disk_ops->set_doorlock(drive, disk, 0);
		drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
	}

	idkp->openers--;

	ide_disk_put(idkp);
	mutex_unlock(&ide_gd_mutex);

	return 0;
}

static int ide_gd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
{
	struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;

	geo->heads = drive->bios_head;
	geo->sectors = drive->bios_sect;
	geo->cylinders = (u16)drive->bios_cyl; /* truncate */
	return 0;
}

static unsigned int ide_gd_check_events(struct gendisk *disk,
					unsigned int clearing)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;
	bool ret;

	/* do not scan partitions twice if this is a removable device */
	if (drive->dev_flags & IDE_DFLAG_ATTACH) {
		drive->dev_flags &= ~IDE_DFLAG_ATTACH;
		return 0;
	}

	/*
	 * The following is used to force revalidation on the first open on
	 * removeable devices, and never gets reported to userland as
	 * genhd->events is 0.  This is intended as removeable ide disk
	 * can't really detect MEDIA_CHANGE events.
	 */
	ret = drive->dev_flags & IDE_DFLAG_MEDIA_CHANGED;
	drive->dev_flags &= ~IDE_DFLAG_MEDIA_CHANGED;

	return ret ? DISK_EVENT_MEDIA_CHANGE : 0;
}

static void ide_gd_unlock_native_capacity(struct gendisk *disk)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;
	const struct ide_disk_ops *disk_ops = drive->disk_ops;

	if (disk_ops->unlock_native_capacity)
		disk_ops->unlock_native_capacity(drive);
}

static int ide_gd_revalidate_disk(struct gendisk *disk)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;

	if (ide_gd_check_events(disk, 0))
		drive->disk_ops->get_capacity(drive);

	set_capacity(disk, ide_gd_capacity(drive));
	return 0;
}

static int ide_gd_ioctl(struct block_device *bdev, fmode_t mode,
			     unsigned int cmd, unsigned long arg)
{
	struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;

	return drive->disk_ops->ioctl(drive, bdev, mode, cmd, arg);
}

static const struct block_device_operations ide_gd_ops = {
	.owner			= THIS_MODULE,
	.open			= ide_gd_unlocked_open,
	.release		= ide_gd_release,
	.ioctl			= ide_gd_ioctl,
	.getgeo			= ide_gd_getgeo,
	.check_events		= ide_gd_check_events,
	.unlock_native_capacity	= ide_gd_unlock_native_capacity,
	.revalidate_disk	= ide_gd_revalidate_disk
};

static int ide_gd_probe(ide_drive_t *drive)
{
	const struct ide_disk_ops *disk_ops = NULL;
	struct ide_disk_obj *idkp;
	struct gendisk *g;

	/* strstr("foo", "") is non-NULL */
	if (!strstr("ide-gd", drive->driver_req))
		goto failed;

#ifdef CONFIG_IDE_GD_ATA
	if (drive->media == ide_disk)
		disk_ops = &ide_ata_disk_ops;
#endif
#ifdef CONFIG_IDE_GD_ATAPI
	if (drive->media == ide_floppy)
		disk_ops = &ide_atapi_disk_ops;
#endif
	if (disk_ops == NULL)
		goto failed;

	if (disk_ops->check(drive, DRV_NAME) == 0) {
		printk(KERN_ERR PFX "%s: not supported by this driver\n",
			drive->name);
		goto failed;
	}

	idkp = kzalloc(sizeof(*idkp), GFP_KERNEL);
	if (!idkp) {
		printk(KERN_ERR PFX "%s: can't allocate a disk structure\n",
			drive->name);
		goto failed;
	}

	g = alloc_disk_node(IDE_DISK_MINORS, hwif_to_node(drive->hwif));
	if (!g)
		goto out_free_idkp;

	ide_init_disk(g, drive);

	idkp->dev.parent = &drive->gendev;
	idkp->dev.release = ide_disk_release;
	dev_set_name(&idkp->dev, dev_name(&drive->gendev));

	if (device_register(&idkp->dev))
		goto out_free_disk;

	idkp->drive = drive;
	idkp->driver = &ide_gd_driver;
	idkp->disk = g;

	g->private_data = &idkp->driver;

	drive->driver_data = idkp;
	drive->debug_mask = debug_mask;
	drive->disk_ops = disk_ops;

	disk_ops->setup(drive);

	set_capacity(g, ide_gd_capacity(drive));

	g->minors = IDE_DISK_MINORS;
	g->driverfs_dev = &drive->gendev;
	g->flags |= GENHD_FL_EXT_DEVT;
	if (drive->dev_flags & IDE_DFLAG_REMOVABLE)
		g->flags = GENHD_FL_REMOVABLE;
	g->fops = &ide_gd_ops;
	add_disk(g);
	return 0;

out_free_disk:
	put_disk(g);
out_free_idkp:
	kfree(idkp);
failed:
	return -ENODEV;
}

static int __init ide_gd_init(void)
{
	printk(KERN_INFO DRV_NAME " driver " IDE_GD_VERSION "\n");
	return driver_register(&ide_gd_driver.gen_driver);
}

static void __exit ide_gd_exit(void)
{
	driver_unregister(&ide_gd_driver.gen_driver);
}

MODULE_ALIAS("ide:*m-disk*");
MODULE_ALIAS("ide-disk");
MODULE_ALIAS("ide:*m-floppy*");
MODULE_ALIAS("ide-floppy");
module_init(ide_gd_init);
module_exit(ide_gd_exit);
MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("generic ATA/ATAPI disk driver");
Commit	Line	Data
	1	#include <linux/module.h>
	2	#include <linux/types.h>
	3	#include <linux/string.h>
	4	#include <linux/kernel.h>
	5	#include <linux/errno.h>
	6	#include <linux/genhd.h>
	7	#include <linux/mutex.h>
	8	#include <linux/ide.h>
	9	#include <linux/hdreg.h>
	10	#include <linux/dmi.h>
	11	#include <linux/slab.h>
	12
	13	#if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
	14	#define IDE_DISK_MINORS (1 << PARTN_BITS)
	15	#else
	16	#define IDE_DISK_MINORS 0
	17	#endif
	18
	19	#include "ide-disk.h"
	20	#include "ide-floppy.h"
	21
	22	#define IDE_GD_VERSION "1.18"
	23
	24	/* module parameters */
	25	static DEFINE_MUTEX(ide_gd_mutex);
	26	static unsigned long debug_mask;
	27	module_param(debug_mask, ulong, 0644);
	28
	29	static DEFINE_MUTEX(ide_disk_ref_mutex);
	30
	31	static void ide_disk_release(struct device *);
	32
	33	static struct ide_disk_obj ide_disk_get(struct gendisk disk)
	34	{
	35	struct ide_disk_obj *idkp = NULL;
	36
	37	mutex_lock(&ide_disk_ref_mutex);
	38	idkp = ide_drv_g(disk, ide_disk_obj);
	39	if (idkp) {
	40	if (ide_device_get(idkp->drive))
	41	idkp = NULL;
	42	else
	43	get_device(&idkp->dev);
	44	}
	45	mutex_unlock(&ide_disk_ref_mutex);
	46	return idkp;
	47	}
	48
	49	static void ide_disk_put(struct ide_disk_obj *idkp)
	50	{
	51	ide_drive_t *drive = idkp->drive;
	52
	53	mutex_lock(&ide_disk_ref_mutex);
	54	put_device(&idkp->dev);
	55	ide_device_put(drive);
	56	mutex_unlock(&ide_disk_ref_mutex);
	57	}
	58
	59	sector_t ide_gd_capacity(ide_drive_t *drive)
	60	{
	61	return drive->capacity64;
	62	}
	63
	64	static int ide_gd_probe(ide_drive_t *);
	65
	66	static void ide_gd_remove(ide_drive_t *drive)
	67	{
	68	struct ide_disk_obj *idkp = drive->driver_data;
	69	struct gendisk *g = idkp->disk;
	70
	71	ide_proc_unregister_driver(drive, idkp->driver);
	72	device_del(&idkp->dev);
	73	del_gendisk(g);
	74	drive->disk_ops->flush(drive);
	75
	76	mutex_lock(&ide_disk_ref_mutex);
	77	put_device(&idkp->dev);
	78	mutex_unlock(&ide_disk_ref_mutex);
	79	}
	80
	81	static void ide_disk_release(struct device *dev)
	82	{
	83	struct ide_disk_obj *idkp = to_ide_drv(dev, ide_disk_obj);
	84	ide_drive_t *drive = idkp->drive;
	85	struct gendisk *g = idkp->disk;
	86
	87	drive->disk_ops = NULL;
	88	drive->driver_data = NULL;
	89	g->private_data = NULL;
	90	put_disk(g);
	91	kfree(idkp);
	92	}
	93
	94	/*
	95	* On HPA drives the capacity needs to be
	96	* reinitialized on resume otherwise the disk
	97	* can not be used and a hard reset is required
	98	*/
	99	static void ide_gd_resume(ide_drive_t *drive)
	100	{
	101	if (ata_id_hpa_enabled(drive->id))
	102	(void)drive->disk_ops->get_capacity(drive);
	103	}
	104
	105	static const struct dmi_system_id ide_coldreboot_table[] = {
	106	{
	107	/* Acer TravelMate 66x cuts power during reboot */
	108	.ident = "Acer TravelMate 660",
	109	.matches = {
	110	DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
	111	DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 660"),
	112	},
	113	},
	114
	115	{ } /* terminate list */
	116	};
	117
	118	static void ide_gd_shutdown(ide_drive_t *drive)
	119	{
	120	#ifdef CONFIG_ALPHA
	121	/* On Alpha, halt(8) doesn't actually turn the machine off,
	122	it puts you into the sort of firmware monitor. Typically,
	123	it's used to boot another kernel image, so it's not much
	124	different from reboot(8). Therefore, we don't need to
	125	spin down the disk in this case, especially since Alpha
	126	firmware doesn't handle disks in standby mode properly.
	127	On the other hand, it's reasonably safe to turn the power
	128	off when the shutdown process reaches the firmware prompt,
	129	as the firmware initialization takes rather long time -
	130	at least 10 seconds, which should be sufficient for
	131	the disk to expire its write cache. */
	132	if (system_state != SYSTEM_POWER_OFF) {
	133	#else
	134	if (system_state == SYSTEM_RESTART &&
	135	!dmi_check_system(ide_coldreboot_table)) {
	136	#endif
	137	drive->disk_ops->flush(drive);
	138	return;
	139	}
	140
	141	printk(KERN_INFO "Shutdown: %s\n", drive->name);
	142
	143	drive->gendev.bus->suspend(&drive->gendev, PMSG_SUSPEND);
	144	}
	145
	146	#ifdef CONFIG_IDE_PROC_FS
	147	static ide_proc_entry_t ide_disk_proc_entries(ide_drive_t drive)
	148	{
	149	return (drive->media == ide_disk) ? ide_disk_proc : ide_floppy_proc;
	150	}
	151
	152	static const struct ide_proc_devset ide_disk_proc_devsets(ide_drive_t drive)
	153	{
	154	return (drive->media == ide_disk) ? ide_disk_settings
	155	: ide_floppy_settings;
	156	}
	157	#endif
	158
	159	static ide_startstop_t ide_gd_do_request(ide_drive_t *drive,
	160	struct request *rq, sector_t sector)
	161	{
	162	return drive->disk_ops->do_request(drive, rq, sector);
	163	}
	164
	165	static struct ide_driver ide_gd_driver = {
	166	.gen_driver = {
	167	.owner = THIS_MODULE,
	168	.name = "ide-gd",
	169	.bus = &ide_bus_type,
	170	},
	171	.probe = ide_gd_probe,
	172	.remove = ide_gd_remove,
	173	.resume = ide_gd_resume,
	174	.shutdown = ide_gd_shutdown,
	175	.version = IDE_GD_VERSION,
	176	.do_request = ide_gd_do_request,
	177	#ifdef CONFIG_IDE_PROC_FS
	178	.proc_entries = ide_disk_proc_entries,
	179	.proc_devsets = ide_disk_proc_devsets,
	180	#endif
	181	};
	182
	183	static int ide_gd_open(struct block_device *bdev, fmode_t mode)
	184	{
	185	struct gendisk *disk = bdev->bd_disk;
	186	struct ide_disk_obj *idkp;
	187	ide_drive_t *drive;
	188	int ret = 0;
	189
	190	idkp = ide_disk_get(disk);
	191	if (idkp == NULL)
	192	return -ENXIO;
	193
	194	drive = idkp->drive;
	195
	196	ide_debug_log(IDE_DBG_FUNC, "enter");
	197
	198	idkp->openers++;
	199
	200	if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
	201	drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
	202	/* Just in case */
	203
	204	ret = drive->disk_ops->init_media(drive, disk);
	205
	206	/*
	207	* Allow O_NDELAY to open a drive without a disk, or with an
	208	* unreadable disk, so that we can get the format capacity
	209	* of the drive or begin the format - Sam
	210	*/
	211	if (ret && (mode & FMODE_NDELAY) == 0) {
	212	ret = -EIO;
	213	goto out_put_idkp;
	214	}
	215
	216	if ((drive->dev_flags & IDE_DFLAG_WP) && (mode & FMODE_WRITE)) {
	217	ret = -EROFS;
	218	goto out_put_idkp;
	219	}
	220
	221	/*
	222	* Ignore the return code from door_lock,
	223	* since the open() has already succeeded,
	224	* and the door_lock is irrelevant at this point.
	225	*/
	226	drive->disk_ops->set_doorlock(drive, disk, 1);
	227	drive->dev_flags \|= IDE_DFLAG_MEDIA_CHANGED;
	228	check_disk_change(bdev);
	229	} else if (drive->dev_flags & IDE_DFLAG_FORMAT_IN_PROGRESS) {
	230	ret = -EBUSY;
	231	goto out_put_idkp;
	232	}
	233	return 0;
	234
	235	out_put_idkp:
	236	idkp->openers--;
	237	ide_disk_put(idkp);
	238	return ret;
	239	}
	240
	241	static int ide_gd_unlocked_open(struct block_device *bdev, fmode_t mode)
	242	{
	243	int ret;
	244
	245	mutex_lock(&ide_gd_mutex);
	246	ret = ide_gd_open(bdev, mode);
	247	mutex_unlock(&ide_gd_mutex);
	248
	249	return ret;
	250	}
	251
	252
	253	static int ide_gd_release(struct gendisk *disk, fmode_t mode)
	254	{
	255	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	256	ide_drive_t *drive = idkp->drive;
	257
	258	ide_debug_log(IDE_DBG_FUNC, "enter");
	259
	260	mutex_lock(&ide_gd_mutex);
	261	if (idkp->openers == 1)
	262	drive->disk_ops->flush(drive);
	263
	264	if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
	265	drive->disk_ops->set_doorlock(drive, disk, 0);
	266	drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
	267	}
	268
	269	idkp->openers--;
	270
	271	ide_disk_put(idkp);
	272	mutex_unlock(&ide_gd_mutex);
	273
	274	return 0;
	275	}
	276
	277	static int ide_gd_getgeo(struct block_device bdev, struct hd_geometry geo)
	278	{
	279	struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
	280	ide_drive_t *drive = idkp->drive;
	281
	282	geo->heads = drive->bios_head;
	283	geo->sectors = drive->bios_sect;
	284	geo->cylinders = (u16)drive->bios_cyl; /* truncate */
	285	return 0;
	286	}
	287
	288	static unsigned int ide_gd_check_events(struct gendisk *disk,
	289	unsigned int clearing)
	290	{
	291	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	292	ide_drive_t *drive = idkp->drive;
	293	bool ret;
	294
	295	/* do not scan partitions twice if this is a removable device */
	296	if (drive->dev_flags & IDE_DFLAG_ATTACH) {
	297	drive->dev_flags &= ~IDE_DFLAG_ATTACH;
	298	return 0;
	299	}
	300
	301	/*
	302	* The following is used to force revalidation on the first open on
	303	* removeable devices, and never gets reported to userland as
	304	* genhd->events is 0. This is intended as removeable ide disk
	305	* can't really detect MEDIA_CHANGE events.
	306	*/
	307	ret = drive->dev_flags & IDE_DFLAG_MEDIA_CHANGED;
	308	drive->dev_flags &= ~IDE_DFLAG_MEDIA_CHANGED;
	309
	310	return ret ? DISK_EVENT_MEDIA_CHANGE : 0;
	311	}
	312
	313	static void ide_gd_unlock_native_capacity(struct gendisk *disk)
	314	{
	315	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	316	ide_drive_t *drive = idkp->drive;
	317	const struct ide_disk_ops *disk_ops = drive->disk_ops;
	318
	319	if (disk_ops->unlock_native_capacity)
	320	disk_ops->unlock_native_capacity(drive);
	321	}
	322
	323	static int ide_gd_revalidate_disk(struct gendisk *disk)
	324	{
	325	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	326	ide_drive_t *drive = idkp->drive;
	327
	328	if (ide_gd_check_events(disk, 0))
	329	drive->disk_ops->get_capacity(drive);
	330
	331	set_capacity(disk, ide_gd_capacity(drive));
	332	return 0;
	333	}
	334
	335	static int ide_gd_ioctl(struct block_device *bdev, fmode_t mode,
	336	unsigned int cmd, unsigned long arg)
	337	{
	338	struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
	339	ide_drive_t *drive = idkp->drive;
	340
	341	return drive->disk_ops->ioctl(drive, bdev, mode, cmd, arg);
	342	}
	343
	344	static const struct block_device_operations ide_gd_ops = {
	345	.owner = THIS_MODULE,
	346	.open = ide_gd_unlocked_open,
	347	.release = ide_gd_release,
	348	.ioctl = ide_gd_ioctl,
	349	.getgeo = ide_gd_getgeo,
	350	.check_events = ide_gd_check_events,
	351	.unlock_native_capacity = ide_gd_unlock_native_capacity,
	352	.revalidate_disk = ide_gd_revalidate_disk
	353	};
	354
	355	static int ide_gd_probe(ide_drive_t *drive)
	356	{
	357	const struct ide_disk_ops *disk_ops = NULL;
	358	struct ide_disk_obj *idkp;
	359	struct gendisk *g;
	360
	361	/* strstr("foo", "") is non-NULL */
	362	if (!strstr("ide-gd", drive->driver_req))
	363	goto failed;
	364
	365	#ifdef CONFIG_IDE_GD_ATA
	366	if (drive->media == ide_disk)
	367	disk_ops = &ide_ata_disk_ops;
	368	#endif
	369	#ifdef CONFIG_IDE_GD_ATAPI
	370	if (drive->media == ide_floppy)
	371	disk_ops = &ide_atapi_disk_ops;
	372	#endif
	373	if (disk_ops == NULL)
	374	goto failed;
	375
	376	if (disk_ops->check(drive, DRV_NAME) == 0) {
	377	printk(KERN_ERR PFX "%s: not supported by this driver\n",
	378	drive->name);
	379	goto failed;
	380	}
	381
	382	idkp = kzalloc(sizeof(*idkp), GFP_KERNEL);
	383	if (!idkp) {
	384	printk(KERN_ERR PFX "%s: can't allocate a disk structure\n",
	385	drive->name);
	386	goto failed;
	387	}
	388
	389	g = alloc_disk_node(IDE_DISK_MINORS, hwif_to_node(drive->hwif));
	390	if (!g)
	391	goto out_free_idkp;
	392
	393	ide_init_disk(g, drive);
	394
	395	idkp->dev.parent = &drive->gendev;
	396	idkp->dev.release = ide_disk_release;
	397	dev_set_name(&idkp->dev, dev_name(&drive->gendev));
	398
	399	if (device_register(&idkp->dev))
	400	goto out_free_disk;
	401
	402	idkp->drive = drive;
	403	idkp->driver = &ide_gd_driver;
	404	idkp->disk = g;
	405
	406	g->private_data = &idkp->driver;
	407
	408	drive->driver_data = idkp;
	409	drive->debug_mask = debug_mask;
	410	drive->disk_ops = disk_ops;
	411
	412	disk_ops->setup(drive);
	413
	414	set_capacity(g, ide_gd_capacity(drive));
	415
	416	g->minors = IDE_DISK_MINORS;
	417	g->driverfs_dev = &drive->gendev;
	418	g->flags \|= GENHD_FL_EXT_DEVT;
	419	if (drive->dev_flags & IDE_DFLAG_REMOVABLE)
	420	g->flags = GENHD_FL_REMOVABLE;
	421	g->fops = &ide_gd_ops;
	422	add_disk(g);
	423	return 0;
	424
	425	out_free_disk:
	426	put_disk(g);
	427	out_free_idkp:
	428	kfree(idkp);
	429	failed:
	430	return -ENODEV;
	431	}
	432
	433	static int __init ide_gd_init(void)
	434	{
	435	printk(KERN_INFO DRV_NAME " driver " IDE_GD_VERSION "\n");
	436	return driver_register(&ide_gd_driver.gen_driver);
	437	}
	438
	439	static void __exit ide_gd_exit(void)
	440	{
	441	driver_unregister(&ide_gd_driver.gen_driver);
	442	}
	443
	444	MODULE_ALIAS("ide:m-disk");
	445	MODULE_ALIAS("ide-disk");
	446	MODULE_ALIAS("ide:m-floppy");
	447	MODULE_ALIAS("ide-floppy");
	448	module_init(ide_gd_init);
	449	module_exit(ide_gd_exit);
	450	MODULE_LICENSE("GPL");
	451	MODULE_DESCRIPTION("generic ATA/ATAPI disk driver");