drivers/ide/ide-gd.c

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