75e554c27d
use them to hide the structure of the function pointers we jump through to issue a command.
269 lines
8.0 KiB
C
269 lines
8.0 KiB
C
/* $NetBSD: cd_atapi.c,v 1.6 1997/10/18 19:50:54 thorpej Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1997 Manuel Bouyer. All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by Charles M. Hannum.
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* Originally written by Julian Elischer (julian@tfs.com)
|
|
* for TRW Financial Systems for use under the MACH(2.5) operating system.
|
|
*
|
|
* TRW Financial Systems, in accordance with their agreement with Carnegie
|
|
* Mellon University, makes this software available to CMU to distribute
|
|
* or use in any manner that they see fit as long as this message is kept with
|
|
* the software. For this reason TFS also grants any other persons or
|
|
* organisations permission to use or modify this software.
|
|
*
|
|
* TFS supplies this software to be publicly redistributed
|
|
* on the understanding that TFS is not responsible for the correct
|
|
* functioning of this software in any circumstances.
|
|
*
|
|
* Ported to run under 386BSD by Julian Elischer (julian@tfs.com) Sept 1992
|
|
*/
|
|
|
|
#include "rnd.h"
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/file.h>
|
|
#include <sys/device.h>
|
|
#include <sys/disk.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/conf.h>
|
|
#if NRND > 0
|
|
#include <sys/rnd.h>
|
|
#endif
|
|
|
|
#include <sys/cdio.h>
|
|
|
|
#include <dev/scsipi/scsipi_all.h>
|
|
#include <dev/scsipi/scsipi_cd.h>
|
|
#include <dev/scsipi/atapi_cd.h>
|
|
#include <dev/scsipi/atapiconf.h>
|
|
#include <dev/scsipi/cd_link.h>
|
|
|
|
#ifdef __BROKEN_INDIRECT_CONFIG
|
|
int cd_atapibus_match __P((struct device *, void *, void *));
|
|
#else
|
|
int cd_atapibus_match __P((struct device *, struct cfdata *, void *));
|
|
#endif
|
|
void cd_atapibus_attach __P((struct device *, struct device *, void *));
|
|
|
|
int cd_atapibus_set_mode __P((struct cd_softc *, struct atapi_mode_data *,
|
|
int));
|
|
int cd_atapibus_get_mode __P((struct cd_softc *, struct atapi_mode_data *,
|
|
int, int, int));
|
|
|
|
struct cfattach cd_atapibus_ca = {
|
|
sizeof(struct cd_softc), cd_atapibus_match, cd_atapibus_attach
|
|
};
|
|
|
|
struct scsipi_inquiry_pattern cd_atapibus_patterns[] = {
|
|
{T_CDROM, T_REMOV,
|
|
"", "", ""},
|
|
{T_WORM, T_REMOV,
|
|
"", "", ""},
|
|
{T_DIRECT, T_REMOV,
|
|
"NEC CD-ROM DRIVE:260", "", ""},
|
|
};
|
|
|
|
int cd_atapibus_setchan __P((struct cd_softc *, int, int, int, int));
|
|
int cd_atapibus_getvol __P((struct cd_softc *, struct ioc_vol *));
|
|
int cd_atapibus_setvol __P((struct cd_softc *, const struct ioc_vol *));
|
|
int cd_atapibus_set_pa_immed __P((struct cd_softc *));
|
|
|
|
const struct cd_ops cd_atapibus_ops = {
|
|
cd_atapibus_setchan,
|
|
cd_atapibus_getvol,
|
|
cd_atapibus_setvol,
|
|
cd_atapibus_set_pa_immed,
|
|
};
|
|
|
|
int
|
|
cd_atapibus_match(parent, match, aux)
|
|
struct device *parent;
|
|
#ifdef __BROKEN_INDIRECT_CONFIG
|
|
void *match;
|
|
#else
|
|
struct cfdata *match;
|
|
#endif
|
|
void *aux;
|
|
{
|
|
struct scsipibus_attach_args *sa = aux;
|
|
int priority;
|
|
|
|
if (sa->sa_sc_link->type != BUS_ATAPI)
|
|
return (0);
|
|
|
|
(void)scsipi_inqmatch(&sa->sa_inqbuf,
|
|
(caddr_t)cd_atapibus_patterns,
|
|
sizeof(cd_atapibus_patterns) / sizeof(cd_atapibus_patterns[0]),
|
|
sizeof(cd_atapibus_patterns[0]), &priority);
|
|
return (priority);
|
|
}
|
|
|
|
/*
|
|
* The routine called by the low level scsi routine when it discovers
|
|
* A device suitable for this driver
|
|
*/
|
|
void
|
|
cd_atapibus_attach(parent, self, aux)
|
|
struct device *parent, *self;
|
|
void *aux;
|
|
{
|
|
struct cd_softc *cd = (void *)self;
|
|
struct scsipibus_attach_args *sa = aux;
|
|
struct scsipi_link *sc_link = sa->sa_sc_link;
|
|
|
|
SC_DEBUG(sc_link, SDEV_DB2, ("cdattach: "));
|
|
|
|
cdattach(parent, cd, sc_link, &cd_atapibus_ops);
|
|
|
|
/* XXX should I get the ATAPI_CAP_PAGE here ? */
|
|
}
|
|
|
|
int
|
|
cd_atapibus_get_mode(cd, data, page, len, flags)
|
|
struct cd_softc *cd;
|
|
struct atapi_mode_data *data;
|
|
int page, len, flags;
|
|
{
|
|
struct atapi_mode_sense scsipi_cmd;
|
|
int error;
|
|
|
|
bzero(&scsipi_cmd, sizeof(scsipi_cmd));
|
|
scsipi_cmd.opcode = ATAPI_MODE_SENSE;
|
|
scsipi_cmd.page = page;
|
|
_lto2b(len, scsipi_cmd.length);
|
|
error = scsipi_command(cd->sc_link,
|
|
(struct scsipi_generic *)&scsipi_cmd, sizeof(scsipi_cmd),
|
|
(u_char *)data, sizeof(*data), CDRETRIES, 20000, NULL,
|
|
SCSI_DATA_IN);
|
|
SC_DEBUG(cd->sc_link, SDEV_DB2, ("cd_atapibus_get_mode: error=%d\n",
|
|
error));
|
|
return (error);
|
|
}
|
|
|
|
int
|
|
cd_atapibus_set_mode(cd, data, len)
|
|
struct cd_softc *cd;
|
|
struct atapi_mode_data *data;
|
|
int len;
|
|
{
|
|
struct atapi_mode_select scsipi_cmd;
|
|
int error;
|
|
|
|
_lto2l(0, data->header.length);
|
|
bzero(&scsipi_cmd, sizeof(scsipi_cmd));
|
|
scsipi_cmd.opcode = ATAPI_MODE_SELECT;
|
|
scsipi_cmd.byte2 = AMS_PF;
|
|
scsipi_cmd.page = data->page.page_code;
|
|
_lto2b(len, scsipi_cmd.length);
|
|
error = scsipi_command(cd->sc_link,
|
|
(struct scsipi_generic *)&scsipi_cmd, sizeof(scsipi_cmd),
|
|
(u_char *)data, sizeof(*data), CDRETRIES, 20000, NULL,
|
|
SCSI_DATA_OUT);
|
|
SC_DEBUG(cd->sc_link, SDEV_DB2, ("cd_atapibus_set_mode: error=%d\n",
|
|
error));
|
|
return (error);
|
|
}
|
|
|
|
int
|
|
cd_atapibus_setchan(cd, p0, p1, p2, p3)
|
|
struct cd_softc *cd;
|
|
int p0, p1, p2, p3;
|
|
{
|
|
struct atapi_mode_data data;
|
|
int error;
|
|
|
|
if ((error = cd_atapibus_get_mode(cd, &data, ATAPI_AUDIO_PAGE,
|
|
AUDIOPAGESIZE, 0)) != 0)
|
|
return (error);
|
|
data.page.audio.port[LEFT_PORT].channels = p0;
|
|
data.page.audio.port[RIGHT_PORT].channels = p1;
|
|
data.page.audio.port[2].channels = p2;
|
|
data.page.audio.port[3].channels = p3;
|
|
return (cd_atapibus_set_mode(cd, &data, AUDIOPAGESIZE));
|
|
}
|
|
|
|
int
|
|
cd_atapibus_getvol(cd, arg)
|
|
struct cd_softc *cd;
|
|
struct ioc_vol *arg;
|
|
{
|
|
struct atapi_mode_data data;
|
|
int error;
|
|
|
|
if ((error = cd_atapibus_get_mode(cd, &data, ATAPI_AUDIO_PAGE,
|
|
AUDIOPAGESIZE, 0)) != 0)
|
|
return (error);
|
|
arg->vol[0] = data.page.audio.port[0].volume;
|
|
arg->vol[1] = data.page.audio.port[1].volume;
|
|
arg->vol[2] = data.page.audio.port[2].volume;
|
|
arg->vol[3] = data.page.audio.port[3].volume;
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
cd_atapibus_setvol(cd, arg)
|
|
struct cd_softc *cd;
|
|
const struct ioc_vol *arg;
|
|
{
|
|
struct atapi_mode_data data, mask;
|
|
int error;
|
|
|
|
if ((error = cd_atapibus_get_mode(cd, &data, ATAPI_AUDIO_PAGE,
|
|
AUDIOPAGESIZE, 0)) != 0)
|
|
return (error);
|
|
if ((error = cd_atapibus_get_mode(cd, &mask, ATAPI_AUDIO_PAGE_MASK,
|
|
AUDIOPAGESIZE, 0)) != 0)
|
|
return (error);
|
|
|
|
data.page.audio.port[0].volume = arg->vol[0] &
|
|
mask.page.audio.port[0].volume;
|
|
data.page.audio.port[1].volume = arg->vol[1] &
|
|
mask.page.audio.port[1].volume;
|
|
data.page.audio.port[2].volume = arg->vol[2] &
|
|
mask.page.audio.port[2].volume;
|
|
data.page.audio.port[3].volume = arg->vol[3] &
|
|
mask.page.audio.port[3].volume;
|
|
|
|
return (cd_atapibus_set_mode(cd, &data, AUDIOPAGESIZE));
|
|
}
|
|
|
|
int
|
|
cd_atapibus_set_pa_immed(cd)
|
|
struct cd_softc *cd;
|
|
{
|
|
|
|
/* Noop. */
|
|
return (0);
|
|
}
|