[mirror_ubuntu-artful-kernel.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>

#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 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
 * reinitilized 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 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) {
#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_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");

	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);

	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 int ide_gd_media_changed(struct gendisk *disk)
{
	struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
	ide_drive_t *drive = idkp->drive;
	int 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;
	}

	ret = !!(drive->dev_flags & IDE_DFLAG_MEDIA_CHANGED);
	drive->dev_flags &= ~IDE_DFLAG_MEDIA_CHANGED;

	return ret;
}

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