[net-next-2.6.git] / drivers / ide / ide-devsets.c


#include <linux/kernel.h>
#include <linux/ide.h>

DEFINE_MUTEX(ide_setting_mtx);

ide_devset_get(io_32bit, io_32bit);

static int set_io_32bit(ide_drive_t *drive, int arg)
{
	if (drive->dev_flags & IDE_DFLAG_NO_IO_32BIT)
		return -EPERM;

	if (arg < 0 || arg > 1 + (SUPPORT_VLB_SYNC << 1))
		return -EINVAL;

	drive->io_32bit = arg;

	return 0;
}

ide_devset_get_flag(ksettings, IDE_DFLAG_KEEP_SETTINGS);

static int set_ksettings(ide_drive_t *drive, int arg)
{
	if (arg < 0 || arg > 1)
		return -EINVAL;

	if (arg)
		drive->dev_flags |= IDE_DFLAG_KEEP_SETTINGS;
	else
		drive->dev_flags &= ~IDE_DFLAG_KEEP_SETTINGS;

	return 0;
}

ide_devset_get_flag(using_dma, IDE_DFLAG_USING_DMA);

static int set_using_dma(ide_drive_t *drive, int arg)
{
#ifdef CONFIG_BLK_DEV_IDEDMA
	int err = -EPERM;

	if (arg < 0 || arg > 1)
		return -EINVAL;

	if (ata_id_has_dma(drive->id) == 0)
		goto out;

	if (drive->hwif->dma_ops == NULL)
		goto out;

	err = 0;

	if (arg) {
		if (ide_set_dma(drive))
			err = -EIO;
	} else
		ide_dma_off(drive);

out:
	return err;
#else
	if (arg < 0 || arg > 1)
		return -EINVAL;

	return -EPERM;
#endif
}

/*
 * handle HDIO_SET_PIO_MODE ioctl abusers here, eventually it will go away
 */
static int set_pio_mode_abuse(ide_hwif_t *hwif, u8 req_pio)
{
	switch (req_pio) {
	case 202:
	case 201:
	case 200:
	case 102:
	case 101:
	case 100:
		return (hwif->host_flags & IDE_HFLAG_ABUSE_DMA_MODES) ? 1 : 0;
	case 9:
	case 8:
		return (hwif->host_flags & IDE_HFLAG_ABUSE_PREFETCH) ? 1 : 0;
	case 7:
	case 6:
		return (hwif->host_flags & IDE_HFLAG_ABUSE_FAST_DEVSEL) ? 1 : 0;
	default:
		return 0;
	}
}

static int set_pio_mode(ide_drive_t *drive, int arg)
{
	ide_hwif_t *hwif = drive->hwif;
	const struct ide_port_ops *port_ops = hwif->port_ops;

	if (arg < 0 || arg > 255)
		return -EINVAL;

	if (port_ops == NULL || port_ops->set_pio_mode == NULL ||
	    (hwif->host_flags & IDE_HFLAG_NO_SET_MODE))
		return -ENOSYS;

	if (set_pio_mode_abuse(drive->hwif, arg)) {
		drive->pio_mode = arg + XFER_PIO_0;

		if (arg == 8 || arg == 9) {
			unsigned long flags;

			/* take lock for IDE_DFLAG_[NO_]UNMASK/[NO_]IO_32BIT */
			spin_lock_irqsave(&hwif->lock, flags);
			port_ops->set_pio_mode(hwif, drive);
			spin_unlock_irqrestore(&hwif->lock, flags);
		} else
			port_ops->set_pio_mode(hwif, drive);
	} else {
		int keep_dma = !!(drive->dev_flags & IDE_DFLAG_USING_DMA);

		ide_set_pio(drive, arg);

		if (hwif->host_flags & IDE_HFLAG_SET_PIO_MODE_KEEP_DMA) {
			if (keep_dma)
				ide_dma_on(drive);
		}
	}

	return 0;
}

ide_devset_get_flag(unmaskirq, IDE_DFLAG_UNMASK);

static int set_unmaskirq(ide_drive_t *drive, int arg)
{
	if (drive->dev_flags & IDE_DFLAG_NO_UNMASK)
		return -EPERM;

	if (arg < 0 || arg > 1)
		return -EINVAL;

	if (arg)
		drive->dev_flags |= IDE_DFLAG_UNMASK;
	else
		drive->dev_flags &= ~IDE_DFLAG_UNMASK;

	return 0;
}

ide_ext_devset_rw_sync(io_32bit, io_32bit);
ide_ext_devset_rw_sync(keepsettings, ksettings);
ide_ext_devset_rw_sync(unmaskirq, unmaskirq);
ide_ext_devset_rw_sync(using_dma, using_dma);
__IDE_DEVSET(pio_mode, DS_SYNC, NULL, set_pio_mode);

int ide_devset_execute(ide_drive_t *drive, const struct ide_devset *setting,
		       int arg)
{
	struct request_queue *q = drive->queue;
	struct request *rq;
	int ret = 0;

	if (!(setting->flags & DS_SYNC))
		return setting->set(drive, arg);

	rq = blk_get_request(q, READ, __GFP_WAIT);
	rq->cmd_type = REQ_TYPE_SPECIAL;
	rq->cmd_len = 5;
	rq->cmd[0] = REQ_DEVSET_EXEC;
	*(int *)&rq->cmd[1] = arg;
	rq->special = setting->set;

	if (blk_execute_rq(q, NULL, rq, 0))
		ret = rq->errors;
	blk_put_request(rq);

	return ret;
}

ide_startstop_t ide_do_devset(ide_drive_t *drive, struct request *rq)
{
	int err, (*setfunc)(ide_drive_t *, int) = rq->special;

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