^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) #include <linux/gfp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) #include <linux/ide.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) DEFINE_MUTEX(ide_setting_mtx);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) ide_devset_get(io_32bit, io_32bit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) static int set_io_32bit(ide_drive_t *drive, int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) if (drive->dev_flags & IDE_DFLAG_NO_IO_32BIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) if (arg < 0 || arg > 1 + (SUPPORT_VLB_SYNC << 1))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) drive->io_32bit = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) ide_devset_get_flag(ksettings, IDE_DFLAG_KEEP_SETTINGS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) static int set_ksettings(ide_drive_t *drive, int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) if (arg < 0 || arg > 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) if (arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) drive->dev_flags |= IDE_DFLAG_KEEP_SETTINGS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) drive->dev_flags &= ~IDE_DFLAG_KEEP_SETTINGS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) ide_devset_get_flag(using_dma, IDE_DFLAG_USING_DMA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) static int set_using_dma(ide_drive_t *drive, int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #ifdef CONFIG_BLK_DEV_IDEDMA
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) int err = -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) if (arg < 0 || arg > 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) if (ata_id_has_dma(drive->id) == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) if (drive->hwif->dma_ops == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) err = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) if (arg) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) if (ide_set_dma(drive))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) err = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) ide_dma_off(drive);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) if (arg < 0 || arg > 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) * handle HDIO_SET_PIO_MODE ioctl abusers here, eventually it will go away
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) static int set_pio_mode_abuse(ide_hwif_t *hwif, u8 req_pio)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) switch (req_pio) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) case 202:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) case 201:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) case 200:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) case 102:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) case 101:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) case 100:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) return (hwif->host_flags & IDE_HFLAG_ABUSE_DMA_MODES) ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) case 9:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) case 8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) return (hwif->host_flags & IDE_HFLAG_ABUSE_PREFETCH) ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) case 7:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) case 6:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return (hwif->host_flags & IDE_HFLAG_ABUSE_FAST_DEVSEL) ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) static int set_pio_mode(ide_drive_t *drive, int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) ide_hwif_t *hwif = drive->hwif;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) const struct ide_port_ops *port_ops = hwif->port_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) if (arg < 0 || arg > 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) if (port_ops == NULL || port_ops->set_pio_mode == NULL ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) (hwif->host_flags & IDE_HFLAG_NO_SET_MODE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) return -ENOSYS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) if (set_pio_mode_abuse(drive->hwif, arg)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) drive->pio_mode = arg + XFER_PIO_0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) if (arg == 8 || arg == 9) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) /* take lock for IDE_DFLAG_[NO_]UNMASK/[NO_]IO_32BIT */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) spin_lock_irqsave(&hwif->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) port_ops->set_pio_mode(hwif, drive);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) spin_unlock_irqrestore(&hwif->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) port_ops->set_pio_mode(hwif, drive);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) int keep_dma = !!(drive->dev_flags & IDE_DFLAG_USING_DMA);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) ide_set_pio(drive, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) if (hwif->host_flags & IDE_HFLAG_SET_PIO_MODE_KEEP_DMA) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) if (keep_dma)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) ide_dma_on(drive);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) ide_devset_get_flag(unmaskirq, IDE_DFLAG_UNMASK);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) static int set_unmaskirq(ide_drive_t *drive, int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) if (drive->dev_flags & IDE_DFLAG_NO_UNMASK)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) if (arg < 0 || arg > 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) if (arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) drive->dev_flags |= IDE_DFLAG_UNMASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) drive->dev_flags &= ~IDE_DFLAG_UNMASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) ide_ext_devset_rw_sync(io_32bit, io_32bit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) ide_ext_devset_rw_sync(keepsettings, ksettings);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) ide_ext_devset_rw_sync(unmaskirq, unmaskirq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) ide_ext_devset_rw_sync(using_dma, using_dma);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) __IDE_DEVSET(pio_mode, DS_SYNC, NULL, set_pio_mode);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) int ide_devset_execute(ide_drive_t *drive, const struct ide_devset *setting,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) int arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) struct request_queue *q = drive->queue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) struct request *rq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) if (!(setting->flags & DS_SYNC))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) return setting->set(drive, arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) rq = blk_get_request(q, REQ_OP_DRV_IN, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) ide_req(rq)->type = ATA_PRIV_MISC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) scsi_req(rq)->cmd_len = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) scsi_req(rq)->cmd[0] = REQ_DEVSET_EXEC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) *(int *)&scsi_req(rq)->cmd[1] = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) ide_req(rq)->special = setting->set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) blk_execute_rq(q, NULL, rq, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) ret = scsi_req(rq)->result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) blk_put_request(rq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) ide_startstop_t ide_do_devset(ide_drive_t *drive, struct request *rq)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) int err, (*setfunc)(ide_drive_t *, int) = ide_req(rq)->special;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) err = setfunc(drive, *(int *)&scsi_req(rq)->cmd[1]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) scsi_req(rq)->result = err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) ide_complete_rq(drive, 0, blk_rq_bytes(rq));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) return ide_stopped;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags