treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / ide / ide-gd.c
blob1bb99b5563930c810855d2fe2f23e83e8d619147
1 // SPDX-License-Identifier: GPL-2.0-only
2 #include <linux/module.h>
3 #include <linux/types.h>
4 #include <linux/string.h>
5 #include <linux/kernel.h>
6 #include <linux/errno.h>
7 #include <linux/genhd.h>
8 #include <linux/mutex.h>
9 #include <linux/ide.h>
10 #include <linux/hdreg.h>
11 #include <linux/dmi.h>
12 #include <linux/slab.h>
14 #if !defined(CONFIG_DEBUG_BLOCK_EXT_DEVT)
15 #define IDE_DISK_MINORS (1 << PARTN_BITS)
16 #else
17 #define IDE_DISK_MINORS 0
18 #endif
20 #include "ide-disk.h"
21 #include "ide-floppy.h"
23 #define IDE_GD_VERSION "1.18"
25 /* module parameters */
26 static DEFINE_MUTEX(ide_gd_mutex);
27 static unsigned long debug_mask;
28 module_param(debug_mask, ulong, 0644);
30 static DEFINE_MUTEX(ide_disk_ref_mutex);
32 static void ide_disk_release(struct device *);
34 static struct ide_disk_obj *ide_disk_get(struct gendisk *disk)
36 struct ide_disk_obj *idkp = NULL;
38 mutex_lock(&ide_disk_ref_mutex);
39 idkp = ide_drv_g(disk, ide_disk_obj);
40 if (idkp) {
41 if (ide_device_get(idkp->drive))
42 idkp = NULL;
43 else
44 get_device(&idkp->dev);
46 mutex_unlock(&ide_disk_ref_mutex);
47 return idkp;
50 static void ide_disk_put(struct ide_disk_obj *idkp)
52 ide_drive_t *drive = idkp->drive;
54 mutex_lock(&ide_disk_ref_mutex);
55 put_device(&idkp->dev);
56 ide_device_put(drive);
57 mutex_unlock(&ide_disk_ref_mutex);
60 sector_t ide_gd_capacity(ide_drive_t *drive)
62 return drive->capacity64;
65 static int ide_gd_probe(ide_drive_t *);
67 static void ide_gd_remove(ide_drive_t *drive)
69 struct ide_disk_obj *idkp = drive->driver_data;
70 struct gendisk *g = idkp->disk;
72 ide_proc_unregister_driver(drive, idkp->driver);
73 device_del(&idkp->dev);
74 del_gendisk(g);
75 drive->disk_ops->flush(drive);
77 mutex_lock(&ide_disk_ref_mutex);
78 put_device(&idkp->dev);
79 mutex_unlock(&ide_disk_ref_mutex);
82 static void ide_disk_release(struct device *dev)
84 struct ide_disk_obj *idkp = to_ide_drv(dev, ide_disk_obj);
85 ide_drive_t *drive = idkp->drive;
86 struct gendisk *g = idkp->disk;
88 drive->disk_ops = NULL;
89 drive->driver_data = NULL;
90 g->private_data = NULL;
91 put_disk(g);
92 kfree(idkp);
96 * On HPA drives the capacity needs to be
97 * reinitialized on resume otherwise the disk
98 * can not be used and a hard reset is required
100 static void ide_gd_resume(ide_drive_t *drive)
102 if (ata_id_hpa_enabled(drive->id))
103 (void)drive->disk_ops->get_capacity(drive);
106 static const struct dmi_system_id ide_coldreboot_table[] = {
108 /* Acer TravelMate 66x cuts power during reboot */
109 .ident = "Acer TravelMate 660",
110 .matches = {
111 DMI_MATCH(DMI_SYS_VENDOR, "Acer"),
112 DMI_MATCH(DMI_PRODUCT_NAME, "TravelMate 660"),
116 { } /* terminate list */
119 static void ide_gd_shutdown(ide_drive_t *drive)
121 #ifdef CONFIG_ALPHA
122 /* On Alpha, halt(8) doesn't actually turn the machine off,
123 it puts you into the sort of firmware monitor. Typically,
124 it's used to boot another kernel image, so it's not much
125 different from reboot(8). Therefore, we don't need to
126 spin down the disk in this case, especially since Alpha
127 firmware doesn't handle disks in standby mode properly.
128 On the other hand, it's reasonably safe to turn the power
129 off when the shutdown process reaches the firmware prompt,
130 as the firmware initialization takes rather long time -
131 at least 10 seconds, which should be sufficient for
132 the disk to expire its write cache. */
133 if (system_state != SYSTEM_POWER_OFF) {
134 #else
135 if (system_state == SYSTEM_RESTART &&
136 !dmi_check_system(ide_coldreboot_table)) {
137 #endif
138 drive->disk_ops->flush(drive);
139 return;
142 printk(KERN_INFO "Shutdown: %s\n", drive->name);
144 drive->gendev.bus->suspend(&drive->gendev, PMSG_SUSPEND);
147 #ifdef CONFIG_IDE_PROC_FS
148 static ide_proc_entry_t *ide_disk_proc_entries(ide_drive_t *drive)
150 return (drive->media == ide_disk) ? ide_disk_proc : ide_floppy_proc;
153 static const struct ide_proc_devset *ide_disk_proc_devsets(ide_drive_t *drive)
155 return (drive->media == ide_disk) ? ide_disk_settings
156 : ide_floppy_settings;
158 #endif
160 static ide_startstop_t ide_gd_do_request(ide_drive_t *drive,
161 struct request *rq, sector_t sector)
163 return drive->disk_ops->do_request(drive, rq, sector);
166 static struct ide_driver ide_gd_driver = {
167 .gen_driver = {
168 .owner = THIS_MODULE,
169 .name = "ide-gd",
170 .bus = &ide_bus_type,
172 .probe = ide_gd_probe,
173 .remove = ide_gd_remove,
174 .resume = ide_gd_resume,
175 .shutdown = ide_gd_shutdown,
176 .version = IDE_GD_VERSION,
177 .do_request = ide_gd_do_request,
178 #ifdef CONFIG_IDE_PROC_FS
179 .proc_entries = ide_disk_proc_entries,
180 .proc_devsets = ide_disk_proc_devsets,
181 #endif
184 static int ide_gd_open(struct block_device *bdev, fmode_t mode)
186 struct gendisk *disk = bdev->bd_disk;
187 struct ide_disk_obj *idkp;
188 ide_drive_t *drive;
189 int ret = 0;
191 idkp = ide_disk_get(disk);
192 if (idkp == NULL)
193 return -ENXIO;
195 drive = idkp->drive;
197 ide_debug_log(IDE_DBG_FUNC, "enter");
199 idkp->openers++;
201 if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
202 drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
203 /* Just in case */
205 ret = drive->disk_ops->init_media(drive, disk);
208 * Allow O_NDELAY to open a drive without a disk, or with an
209 * unreadable disk, so that we can get the format capacity
210 * of the drive or begin the format - Sam
212 if (ret && (mode & FMODE_NDELAY) == 0) {
213 ret = -EIO;
214 goto out_put_idkp;
217 if ((drive->dev_flags & IDE_DFLAG_WP) && (mode & FMODE_WRITE)) {
218 ret = -EROFS;
219 goto out_put_idkp;
223 * Ignore the return code from door_lock,
224 * since the open() has already succeeded,
225 * and the door_lock is irrelevant at this point.
227 drive->disk_ops->set_doorlock(drive, disk, 1);
228 drive->dev_flags |= IDE_DFLAG_MEDIA_CHANGED;
229 check_disk_change(bdev);
230 } else if (drive->dev_flags & IDE_DFLAG_FORMAT_IN_PROGRESS) {
231 ret = -EBUSY;
232 goto out_put_idkp;
234 return 0;
236 out_put_idkp:
237 idkp->openers--;
238 ide_disk_put(idkp);
239 return ret;
242 static int ide_gd_unlocked_open(struct block_device *bdev, fmode_t mode)
244 int ret;
246 mutex_lock(&ide_gd_mutex);
247 ret = ide_gd_open(bdev, mode);
248 mutex_unlock(&ide_gd_mutex);
250 return ret;
254 static void ide_gd_release(struct gendisk *disk, fmode_t mode)
256 struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
257 ide_drive_t *drive = idkp->drive;
259 ide_debug_log(IDE_DBG_FUNC, "enter");
261 mutex_lock(&ide_gd_mutex);
262 if (idkp->openers == 1)
263 drive->disk_ops->flush(drive);
265 if ((drive->dev_flags & IDE_DFLAG_REMOVABLE) && idkp->openers == 1) {
266 drive->disk_ops->set_doorlock(drive, disk, 0);
267 drive->dev_flags &= ~IDE_DFLAG_FORMAT_IN_PROGRESS;
270 idkp->openers--;
272 ide_disk_put(idkp);
273 mutex_unlock(&ide_gd_mutex);
276 static int ide_gd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
278 struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
279 ide_drive_t *drive = idkp->drive;
281 geo->heads = drive->bios_head;
282 geo->sectors = drive->bios_sect;
283 geo->cylinders = (u16)drive->bios_cyl; /* truncate */
284 return 0;
287 static unsigned int ide_gd_check_events(struct gendisk *disk,
288 unsigned int clearing)
290 struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
291 ide_drive_t *drive = idkp->drive;
292 bool ret;
294 /* do not scan partitions twice if this is a removable device */
295 if (drive->dev_flags & IDE_DFLAG_ATTACH) {
296 drive->dev_flags &= ~IDE_DFLAG_ATTACH;
297 return 0;
301 * The following is used to force revalidation on the first open on
302 * removeable devices, and never gets reported to userland as
303 * DISK_EVENT_FLAG_UEVENT isn't set in genhd->event_flags.
304 * This is intended as removable ide disk can't really detect
305 * MEDIA_CHANGE events.
307 ret = drive->dev_flags & IDE_DFLAG_MEDIA_CHANGED;
308 drive->dev_flags &= ~IDE_DFLAG_MEDIA_CHANGED;
310 return ret ? DISK_EVENT_MEDIA_CHANGE : 0;
313 static void ide_gd_unlock_native_capacity(struct gendisk *disk)
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;
319 if (disk_ops->unlock_native_capacity)
320 disk_ops->unlock_native_capacity(drive);
323 static int ide_gd_revalidate_disk(struct gendisk *disk)
325 struct ide_disk_obj *idkp = ide_drv_g(disk, ide_disk_obj);
326 ide_drive_t *drive = idkp->drive;
328 if (ide_gd_check_events(disk, 0))
329 drive->disk_ops->get_capacity(drive);
331 set_capacity(disk, ide_gd_capacity(drive));
332 return 0;
335 static int ide_gd_ioctl(struct block_device *bdev, fmode_t mode,
336 unsigned int cmd, unsigned long arg)
338 struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
339 ide_drive_t *drive = idkp->drive;
341 return drive->disk_ops->ioctl(drive, bdev, mode, cmd, arg);
344 #ifdef CONFIG_COMPAT
345 static int ide_gd_compat_ioctl(struct block_device *bdev, fmode_t mode,
346 unsigned int cmd, unsigned long arg)
348 struct ide_disk_obj *idkp = ide_drv_g(bdev->bd_disk, ide_disk_obj);
349 ide_drive_t *drive = idkp->drive;
351 if (!drive->disk_ops->compat_ioctl)
352 return -ENOIOCTLCMD;
354 return drive->disk_ops->compat_ioctl(drive, bdev, mode, cmd, arg);
356 #endif
358 static const struct block_device_operations ide_gd_ops = {
359 .owner = THIS_MODULE,
360 .open = ide_gd_unlocked_open,
361 .release = ide_gd_release,
362 .ioctl = ide_gd_ioctl,
363 #ifdef CONFIG_COMPAT
364 .ioctl = ide_gd_compat_ioctl,
365 #endif
366 .getgeo = ide_gd_getgeo,
367 .check_events = ide_gd_check_events,
368 .unlock_native_capacity = ide_gd_unlock_native_capacity,
369 .revalidate_disk = ide_gd_revalidate_disk
372 static int ide_gd_probe(ide_drive_t *drive)
374 const struct ide_disk_ops *disk_ops = NULL;
375 struct ide_disk_obj *idkp;
376 struct gendisk *g;
378 /* strstr("foo", "") is non-NULL */
379 if (!strstr("ide-gd", drive->driver_req))
380 goto failed;
382 #ifdef CONFIG_IDE_GD_ATA
383 if (drive->media == ide_disk)
384 disk_ops = &ide_ata_disk_ops;
385 #endif
386 #ifdef CONFIG_IDE_GD_ATAPI
387 if (drive->media == ide_floppy)
388 disk_ops = &ide_atapi_disk_ops;
389 #endif
390 if (disk_ops == NULL)
391 goto failed;
393 if (disk_ops->check(drive, DRV_NAME) == 0) {
394 printk(KERN_ERR PFX "%s: not supported by this driver\n",
395 drive->name);
396 goto failed;
399 idkp = kzalloc(sizeof(*idkp), GFP_KERNEL);
400 if (!idkp) {
401 printk(KERN_ERR PFX "%s: can't allocate a disk structure\n",
402 drive->name);
403 goto failed;
406 g = alloc_disk_node(IDE_DISK_MINORS, hwif_to_node(drive->hwif));
407 if (!g)
408 goto out_free_idkp;
410 ide_init_disk(g, drive);
412 idkp->dev.parent = &drive->gendev;
413 idkp->dev.release = ide_disk_release;
414 dev_set_name(&idkp->dev, "%s", dev_name(&drive->gendev));
416 if (device_register(&idkp->dev))
417 goto out_free_disk;
419 idkp->drive = drive;
420 idkp->driver = &ide_gd_driver;
421 idkp->disk = g;
423 g->private_data = &idkp->driver;
425 drive->driver_data = idkp;
426 drive->debug_mask = debug_mask;
427 drive->disk_ops = disk_ops;
429 disk_ops->setup(drive);
431 set_capacity(g, ide_gd_capacity(drive));
433 g->minors = IDE_DISK_MINORS;
434 g->flags |= GENHD_FL_EXT_DEVT;
435 if (drive->dev_flags & IDE_DFLAG_REMOVABLE)
436 g->flags = GENHD_FL_REMOVABLE;
437 g->fops = &ide_gd_ops;
438 g->events = DISK_EVENT_MEDIA_CHANGE;
439 device_add_disk(&drive->gendev, g, NULL);
440 return 0;
442 out_free_disk:
443 put_disk(g);
444 out_free_idkp:
445 kfree(idkp);
446 failed:
447 return -ENODEV;
450 static int __init ide_gd_init(void)
452 printk(KERN_INFO DRV_NAME " driver " IDE_GD_VERSION "\n");
453 return driver_register(&ide_gd_driver.gen_driver);
456 static void __exit ide_gd_exit(void)
458 driver_unregister(&ide_gd_driver.gen_driver);
461 MODULE_ALIAS("ide:*m-disk*");
462 MODULE_ALIAS("ide-disk");
463 MODULE_ALIAS("ide:*m-floppy*");
464 MODULE_ALIAS("ide-floppy");
465 module_init(ide_gd_init);
466 module_exit(ide_gd_exit);
467 MODULE_LICENSE("GPL");
468 MODULE_DESCRIPTION("generic ATA/ATAPI disk driver");