ide-cd: move the remaining cdrom.c ioctl handling code to ide-cd_ioctl.c
There should be no functional changes from this. Signed-off-by: Borislav Petkov <bbpetkov@yahoo.de> Signed-off-by: Bartlomiej Zolnierkiewicz <bzolnier@gmail.com>
This commit is contained in:
Borislav Petkov
Bartlomiej Zolnierkiewicz
Родитель
d554336514
Коммит
f9afd18b58
|
|
@ -1381,7 +1381,7 @@ void msf_from_bcd (struct atapi_msf *msf)
|
|||
msf->frame = BCD2BIN(msf->frame);
|
||||
}
|
||||
|
||||
static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
|
||||
int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
|
||||
{
|
||||
struct request req;
|
||||
struct cdrom_info *info = drive->driver_data;
|
||||
|
|
@ -1402,85 +1402,6 @@ static int cdrom_check_status(ide_drive_t *drive, struct request_sense *sense)
|
|||
return ide_cd_queue_pc(drive, &req);
|
||||
}
|
||||
|
||||
/* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
|
||||
int ide_cd_lockdoor(ide_drive_t *drive, int lockflag,
|
||||
struct request_sense *sense)
|
||||
{
|
||||
struct cdrom_info *cd = drive->driver_data;
|
||||
struct request_sense my_sense;
|
||||
struct request req;
|
||||
int stat;
|
||||
|
||||
if (sense == NULL)
|
||||
sense = &my_sense;
|
||||
|
||||
/* If the drive cannot lock the door, just pretend. */
|
||||
if (cd->cd_flags & IDE_CD_FLAG_NO_DOORLOCK) {
|
||||
stat = 0;
|
||||
} else {
|
||||
ide_cd_init_rq(drive, &req);
|
||||
req.sense = sense;
|
||||
req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
|
||||
req.cmd[4] = lockflag ? 1 : 0;
|
||||
stat = ide_cd_queue_pc(drive, &req);
|
||||
}
|
||||
|
||||
/* If we got an illegal field error, the drive
|
||||
probably cannot lock the door. */
|
||||
if (stat != 0 &&
|
||||
sense->sense_key == ILLEGAL_REQUEST &&
|
||||
(sense->asc == 0x24 || sense->asc == 0x20)) {
|
||||
printk (KERN_ERR "%s: door locking not supported\n",
|
||||
drive->name);
|
||||
cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
|
||||
stat = 0;
|
||||
}
|
||||
|
||||
/* no medium, that's alright. */
|
||||
if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
|
||||
stat = 0;
|
||||
|
||||
if (stat == 0) {
|
||||
if (lockflag)
|
||||
cd->cd_flags |= IDE_CD_FLAG_DOOR_LOCKED;
|
||||
else
|
||||
cd->cd_flags &= ~IDE_CD_FLAG_DOOR_LOCKED;
|
||||
}
|
||||
|
||||
return stat;
|
||||
}
|
||||
|
||||
|
||||
/* Eject the disk if EJECTFLAG is 0.
|
||||
If EJECTFLAG is 1, try to reload the disk. */
|
||||
static int cdrom_eject(ide_drive_t *drive, int ejectflag,
|
||||
struct request_sense *sense)
|
||||
{
|
||||
struct cdrom_info *cd = drive->driver_data;
|
||||
struct cdrom_device_info *cdi = &cd->devinfo;
|
||||
struct request req;
|
||||
char loej = 0x02;
|
||||
|
||||
if ((cd->cd_flags & IDE_CD_FLAG_NO_EJECT) && !ejectflag)
|
||||
return -EDRIVE_CANT_DO_THIS;
|
||||
|
||||
/* reload fails on some drives, if the tray is locked */
|
||||
if ((cd->cd_flags & IDE_CD_FLAG_DOOR_LOCKED) && ejectflag)
|
||||
return 0;
|
||||
|
||||
ide_cd_init_rq(drive, &req);
|
||||
|
||||
/* only tell drive to close tray if open, if it can do that */
|
||||
if (ejectflag && (cdi->mask & CDC_CLOSE_TRAY))
|
||||
loej = 0;
|
||||
|
||||
req.sense = sense;
|
||||
req.cmd[0] = GPCMD_START_STOP_UNIT;
|
||||
req.cmd[4] = loej | (ejectflag != 0);
|
||||
|
||||
return ide_cd_queue_pc(drive, &req);
|
||||
}
|
||||
|
||||
static int cdrom_read_capacity(ide_drive_t *drive, unsigned long *capacity,
|
||||
unsigned long *sectors_per_frame,
|
||||
struct request_sense *sense)
|
||||
|
|
@ -1696,53 +1617,6 @@ int ide_cd_read_toc(ide_drive_t *drive, struct request_sense *sense)
|
|||
return 0;
|
||||
}
|
||||
|
||||
/* the generic packet interface to cdrom.c */
|
||||
static int ide_cdrom_packet(struct cdrom_device_info *cdi,
|
||||
struct packet_command *cgc)
|
||||
{
|
||||
struct request req;
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
|
||||
if (cgc->timeout <= 0)
|
||||
cgc->timeout = ATAPI_WAIT_PC;
|
||||
|
||||
/* here we queue the commands from the uniform CD-ROM
|
||||
layer. the packet must be complete, as we do not
|
||||
touch it at all. */
|
||||
ide_cd_init_rq(drive, &req);
|
||||
memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
|
||||
if (cgc->sense)
|
||||
memset(cgc->sense, 0, sizeof(struct request_sense));
|
||||
req.data = cgc->buffer;
|
||||
req.data_len = cgc->buflen;
|
||||
req.timeout = cgc->timeout;
|
||||
|
||||
if (cgc->quiet)
|
||||
req.cmd_flags |= REQ_QUIET;
|
||||
|
||||
req.sense = cgc->sense;
|
||||
cgc->stat = ide_cd_queue_pc(drive, &req);
|
||||
if (!cgc->stat)
|
||||
cgc->buflen -= req.data_len;
|
||||
return cgc->stat;
|
||||
}
|
||||
|
||||
static
|
||||
int ide_cdrom_tray_move (struct cdrom_device_info *cdi, int position)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
struct request_sense sense;
|
||||
|
||||
if (position) {
|
||||
int stat = ide_cd_lockdoor(drive, 0, &sense);
|
||||
|
||||
if (stat)
|
||||
return stat;
|
||||
}
|
||||
|
||||
return cdrom_eject(drive, !position, &sense);
|
||||
}
|
||||
|
||||
int ide_cdrom_get_capabilities(ide_drive_t *drive, u8 *buf)
|
||||
{
|
||||
struct cdrom_info *info = drive->driver_data;
|
||||
|
|
@ -1782,95 +1656,6 @@ void ide_cdrom_update_speed(ide_drive_t *drive, u8 *buf)
|
|||
cd->max_speed = (maxspeed + (176/2)) / 176;
|
||||
}
|
||||
|
||||
/*
|
||||
* add logic to try GET_EVENT command first to check for media and tray
|
||||
* status. this should be supported by newer cd-r/w and all DVD etc
|
||||
* drives
|
||||
*/
|
||||
static
|
||||
int ide_cdrom_drive_status (struct cdrom_device_info *cdi, int slot_nr)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
struct media_event_desc med;
|
||||
struct request_sense sense;
|
||||
int stat;
|
||||
|
||||
if (slot_nr != CDSL_CURRENT)
|
||||
return -EINVAL;
|
||||
|
||||
stat = cdrom_check_status(drive, &sense);
|
||||
if (!stat || sense.sense_key == UNIT_ATTENTION)
|
||||
return CDS_DISC_OK;
|
||||
|
||||
if (!cdrom_get_media_event(cdi, &med)) {
|
||||
if (med.media_present)
|
||||
return CDS_DISC_OK;
|
||||
else if (med.door_open)
|
||||
return CDS_TRAY_OPEN;
|
||||
else
|
||||
return CDS_NO_DISC;
|
||||
}
|
||||
|
||||
if (sense.sense_key == NOT_READY && sense.asc == 0x04 && sense.ascq == 0x04)
|
||||
return CDS_DISC_OK;
|
||||
|
||||
/*
|
||||
* If not using Mt Fuji extended media tray reports,
|
||||
* just return TRAY_OPEN since ATAPI doesn't provide
|
||||
* any other way to detect this...
|
||||
*/
|
||||
if (sense.sense_key == NOT_READY) {
|
||||
if (sense.asc == 0x3a && sense.ascq == 1)
|
||||
return CDS_NO_DISC;
|
||||
else
|
||||
return CDS_TRAY_OPEN;
|
||||
}
|
||||
return CDS_DRIVE_NOT_READY;
|
||||
}
|
||||
|
||||
/****************************************************************************
|
||||
* Other driver requests (open, close, check media change).
|
||||
*/
|
||||
|
||||
static
|
||||
int ide_cdrom_check_media_change_real (struct cdrom_device_info *cdi,
|
||||
int slot_nr)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
struct cdrom_info *cd = drive->driver_data;
|
||||
int retval;
|
||||
|
||||
if (slot_nr == CDSL_CURRENT) {
|
||||
(void) cdrom_check_status(drive, NULL);
|
||||
retval = (cd->cd_flags & IDE_CD_FLAG_MEDIA_CHANGED) ? 1 : 0;
|
||||
cd->cd_flags &= ~IDE_CD_FLAG_MEDIA_CHANGED;
|
||||
return retval;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
int ide_cdrom_open_real (struct cdrom_device_info *cdi, int purpose)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Close down the device. Invalidate all cached blocks.
|
||||
*/
|
||||
|
||||
static
|
||||
void ide_cdrom_release_real (struct cdrom_device_info *cdi)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
struct cdrom_info *cd = drive->driver_data;
|
||||
|
||||
if (!cdi->use_count)
|
||||
cd->cd_flags &= ~IDE_CD_FLAG_TOC_VALID;
|
||||
}
|
||||
|
||||
#define IDE_CD_CAPABILITIES \
|
||||
(CDC_CLOSE_TRAY | CDC_OPEN_TRAY | CDC_LOCK | CDC_SELECT_SPEED | \
|
||||
CDC_SELECT_DISC | CDC_MULTI_SESSION | CDC_MCN | CDC_MEDIA_CHANGED | \
|
||||
|
|
|
|||
|
|
@ -151,12 +151,17 @@ void ide_cd_log_error(const char *, struct request *, struct request_sense *);
|
|||
/* ide-cd.c functions used by ide-cd_ioctl.c */
|
||||
void ide_cd_init_rq(ide_drive_t *, struct request *);
|
||||
int ide_cd_queue_pc(ide_drive_t *, struct request *);
|
||||
int ide_cd_lockdoor(ide_drive_t *, int, struct request_sense *);
|
||||
int ide_cd_read_toc(ide_drive_t *, struct request_sense *);
|
||||
int ide_cdrom_get_capabilities(ide_drive_t *, u8 *);
|
||||
void ide_cdrom_update_speed(ide_drive_t *, u8 *);
|
||||
int cdrom_check_status(ide_drive_t *, struct request_sense *);
|
||||
|
||||
/* ide-cd_ioctl.c */
|
||||
int ide_cdrom_open_real(struct cdrom_device_info *, int);
|
||||
void ide_cdrom_release_real(struct cdrom_device_info *);
|
||||
int ide_cdrom_drive_status(struct cdrom_device_info *, int);
|
||||
int ide_cdrom_check_media_change_real(struct cdrom_device_info *, int);
|
||||
int ide_cdrom_tray_move(struct cdrom_device_info *, int);
|
||||
int ide_cdrom_lock_door(struct cdrom_device_info *, int);
|
||||
int ide_cdrom_select_speed(struct cdrom_device_info *, int);
|
||||
int ide_cdrom_get_last_session(struct cdrom_device_info *,
|
||||
|
|
@ -164,5 +169,6 @@ int ide_cdrom_get_last_session(struct cdrom_device_info *,
|
|||
int ide_cdrom_get_mcn(struct cdrom_device_info *, struct cdrom_mcn *);
|
||||
int ide_cdrom_reset(struct cdrom_device_info *cdi);
|
||||
int ide_cdrom_audio_ioctl(struct cdrom_device_info *, unsigned int, void *);
|
||||
int ide_cdrom_packet(struct cdrom_device_info *, struct packet_command *);
|
||||
|
||||
#endif /* _IDE_CD_H */
|
||||
|
|
|
|||
|
|
@ -9,9 +9,188 @@
|
|||
#include <linux/kernel.h>
|
||||
#include <linux/cdrom.h>
|
||||
#include <linux/ide.h>
|
||||
#include <scsi/scsi.h>
|
||||
|
||||
#include "ide-cd.h"
|
||||
|
||||
/****************************************************************************
|
||||
* Other driver requests (open, close, check media change).
|
||||
*/
|
||||
int ide_cdrom_open_real(struct cdrom_device_info *cdi, int purpose)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Close down the device. Invalidate all cached blocks.
|
||||
*/
|
||||
void ide_cdrom_release_real(struct cdrom_device_info *cdi)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
struct cdrom_info *cd = drive->driver_data;
|
||||
|
||||
if (!cdi->use_count)
|
||||
cd->cd_flags &= ~IDE_CD_FLAG_TOC_VALID;
|
||||
}
|
||||
|
||||
/*
|
||||
* add logic to try GET_EVENT command first to check for media and tray
|
||||
* status. this should be supported by newer cd-r/w and all DVD etc
|
||||
* drives
|
||||
*/
|
||||
int ide_cdrom_drive_status(struct cdrom_device_info *cdi, int slot_nr)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
struct media_event_desc med;
|
||||
struct request_sense sense;
|
||||
int stat;
|
||||
|
||||
if (slot_nr != CDSL_CURRENT)
|
||||
return -EINVAL;
|
||||
|
||||
stat = cdrom_check_status(drive, &sense);
|
||||
if (!stat || sense.sense_key == UNIT_ATTENTION)
|
||||
return CDS_DISC_OK;
|
||||
|
||||
if (!cdrom_get_media_event(cdi, &med)) {
|
||||
if (med.media_present)
|
||||
return CDS_DISC_OK;
|
||||
else if (med.door_open)
|
||||
return CDS_TRAY_OPEN;
|
||||
else
|
||||
return CDS_NO_DISC;
|
||||
}
|
||||
|
||||
if (sense.sense_key == NOT_READY && sense.asc == 0x04
|
||||
&& sense.ascq == 0x04)
|
||||
return CDS_DISC_OK;
|
||||
|
||||
/*
|
||||
* If not using Mt Fuji extended media tray reports,
|
||||
* just return TRAY_OPEN since ATAPI doesn't provide
|
||||
* any other way to detect this...
|
||||
*/
|
||||
if (sense.sense_key == NOT_READY) {
|
||||
if (sense.asc == 0x3a && sense.ascq == 1)
|
||||
return CDS_NO_DISC;
|
||||
else
|
||||
return CDS_TRAY_OPEN;
|
||||
}
|
||||
return CDS_DRIVE_NOT_READY;
|
||||
}
|
||||
|
||||
int ide_cdrom_check_media_change_real(struct cdrom_device_info *cdi,
|
||||
int slot_nr)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
struct cdrom_info *cd = drive->driver_data;
|
||||
int retval;
|
||||
|
||||
if (slot_nr == CDSL_CURRENT) {
|
||||
(void) cdrom_check_status(drive, NULL);
|
||||
retval = (cd->cd_flags & IDE_CD_FLAG_MEDIA_CHANGED) ? 1 : 0;
|
||||
cd->cd_flags &= ~IDE_CD_FLAG_MEDIA_CHANGED;
|
||||
return retval;
|
||||
} else {
|
||||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
/* Eject the disk if EJECTFLAG is 0.
|
||||
If EJECTFLAG is 1, try to reload the disk. */
|
||||
static
|
||||
int cdrom_eject(ide_drive_t *drive, int ejectflag,
|
||||
struct request_sense *sense)
|
||||
{
|
||||
struct cdrom_info *cd = drive->driver_data;
|
||||
struct cdrom_device_info *cdi = &cd->devinfo;
|
||||
struct request req;
|
||||
char loej = 0x02;
|
||||
|
||||
if ((cd->cd_flags & IDE_CD_FLAG_NO_EJECT) && !ejectflag)
|
||||
return -EDRIVE_CANT_DO_THIS;
|
||||
|
||||
/* reload fails on some drives, if the tray is locked */
|
||||
if ((cd->cd_flags & IDE_CD_FLAG_DOOR_LOCKED) && ejectflag)
|
||||
return 0;
|
||||
|
||||
ide_cd_init_rq(drive, &req);
|
||||
|
||||
/* only tell drive to close tray if open, if it can do that */
|
||||
if (ejectflag && (cdi->mask & CDC_CLOSE_TRAY))
|
||||
loej = 0;
|
||||
|
||||
req.sense = sense;
|
||||
req.cmd[0] = GPCMD_START_STOP_UNIT;
|
||||
req.cmd[4] = loej | (ejectflag != 0);
|
||||
|
||||
return ide_cd_queue_pc(drive, &req);
|
||||
}
|
||||
|
||||
/* Lock the door if LOCKFLAG is nonzero; unlock it otherwise. */
|
||||
static
|
||||
int ide_cd_lockdoor(ide_drive_t *drive, int lockflag,
|
||||
struct request_sense *sense)
|
||||
{
|
||||
struct cdrom_info *cd = drive->driver_data;
|
||||
struct request_sense my_sense;
|
||||
struct request req;
|
||||
int stat;
|
||||
|
||||
if (sense == NULL)
|
||||
sense = &my_sense;
|
||||
|
||||
/* If the drive cannot lock the door, just pretend. */
|
||||
if (cd->cd_flags & IDE_CD_FLAG_NO_DOORLOCK) {
|
||||
stat = 0;
|
||||
} else {
|
||||
ide_cd_init_rq(drive, &req);
|
||||
req.sense = sense;
|
||||
req.cmd[0] = GPCMD_PREVENT_ALLOW_MEDIUM_REMOVAL;
|
||||
req.cmd[4] = lockflag ? 1 : 0;
|
||||
stat = ide_cd_queue_pc(drive, &req);
|
||||
}
|
||||
|
||||
/* If we got an illegal field error, the drive
|
||||
probably cannot lock the door. */
|
||||
if (stat != 0 &&
|
||||
sense->sense_key == ILLEGAL_REQUEST &&
|
||||
(sense->asc == 0x24 || sense->asc == 0x20)) {
|
||||
printk(KERN_ERR "%s: door locking not supported\n",
|
||||
drive->name);
|
||||
cd->cd_flags |= IDE_CD_FLAG_NO_DOORLOCK;
|
||||
stat = 0;
|
||||
}
|
||||
|
||||
/* no medium, that's alright. */
|
||||
if (stat != 0 && sense->sense_key == NOT_READY && sense->asc == 0x3a)
|
||||
stat = 0;
|
||||
|
||||
if (stat == 0) {
|
||||
if (lockflag)
|
||||
cd->cd_flags |= IDE_CD_FLAG_DOOR_LOCKED;
|
||||
else
|
||||
cd->cd_flags &= ~IDE_CD_FLAG_DOOR_LOCKED;
|
||||
}
|
||||
|
||||
return stat;
|
||||
}
|
||||
|
||||
int ide_cdrom_tray_move(struct cdrom_device_info *cdi, int position)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
struct request_sense sense;
|
||||
|
||||
if (position) {
|
||||
int stat = ide_cd_lockdoor(drive, 0, &sense);
|
||||
|
||||
if (stat)
|
||||
return stat;
|
||||
}
|
||||
|
||||
return cdrom_eject(drive, !position, &sense);
|
||||
}
|
||||
|
||||
int ide_cdrom_lock_door(struct cdrom_device_info *cdi, int lock)
|
||||
{
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
|
|
@ -263,3 +442,34 @@ int ide_cdrom_audio_ioctl(struct cdrom_device_info *cdi,
|
|||
return -EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
/* the generic packet interface to cdrom.c */
|
||||
int ide_cdrom_packet(struct cdrom_device_info *cdi,
|
||||
struct packet_command *cgc)
|
||||
{
|
||||
struct request req;
|
||||
ide_drive_t *drive = cdi->handle;
|
||||
|
||||
if (cgc->timeout <= 0)
|
||||
cgc->timeout = ATAPI_WAIT_PC;
|
||||
|
||||
/* here we queue the commands from the uniform CD-ROM
|
||||
layer. the packet must be complete, as we do not
|
||||
touch it at all. */
|
||||
ide_cd_init_rq(drive, &req);
|
||||
memcpy(req.cmd, cgc->cmd, CDROM_PACKET_SIZE);
|
||||
if (cgc->sense)
|
||||
memset(cgc->sense, 0, sizeof(struct request_sense));
|
||||
req.data = cgc->buffer;
|
||||
req.data_len = cgc->buflen;
|
||||
req.timeout = cgc->timeout;
|
||||
|
||||
if (cgc->quiet)
|
||||
req.cmd_flags |= REQ_QUIET;
|
||||
|
||||
req.sense = cgc->sense;
|
||||
cgc->stat = ide_cd_queue_pc(drive, &req);
|
||||
if (!cgc->stat)
|
||||
cgc->buflen -= req.data_len;
|
||||
return cgc->stat;
|
||||
}
|
||||
|
|
|
|||
Загрузка…
Ссылка в новой задаче