summaryrefslogtreecommitdiffstats
path: root/sys/dev/mcd/mcd.c
diff options
context:
space:
mode:
authorrgrimes <rgrimes@FreeBSD.org>1994-02-22 08:44:31 +0000
committerrgrimes <rgrimes@FreeBSD.org>1994-02-22 08:44:31 +0000
commita211a547e1ed79a88095f60cb826f8c1a6dada6f (patch)
tree3d99c4d4fa34c5e32347fc746cbdf80fcea3883f /sys/dev/mcd/mcd.c
parenta55e9da79eea563311a64695596530aee9cf8510 (diff)
downloadFreeBSD-src-a211a547e1ed79a88095f60cb826f8c1a6dada6f.zip
FreeBSD-src-a211a547e1ed79a88095f60cb826f8c1a6dada6f.tar.gz
This is Jordans probe code fixes. Tested on LU002, FX001D. Then I went
in and cleaned the spaces vs tabs up, and made the code a little closer to KNF.
Diffstat (limited to 'sys/dev/mcd/mcd.c')
-rw-r--r--sys/dev/mcd/mcd.c337
1 files changed, 213 insertions, 124 deletions
diff --git a/sys/dev/mcd/mcd.c b/sys/dev/mcd/mcd.c
index c947a2a..141cb0e 100644
--- a/sys/dev/mcd/mcd.c
+++ b/sys/dev/mcd/mcd.c
@@ -1,7 +1,11 @@
/*
* Copyright 1993 by Holger Veit (data part)
* Copyright 1993 by Brian Moore (audio part)
- * Changes Copyright 1993 by Gary Clark II
+ * Changes Copyright 1993 by Gary Clark II
+ *
+ * Rewrote probe routine to work on newer Mitsumi drives.
+ * Additional changes (C) 1994 by Jordan K. Hubbard
+ *
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
@@ -15,7 +19,7 @@
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This software was developed by Holger Veit and Brian Moore
- * for use with "386BSD" and similar operating systems.
+ * for use with "386BSD" and similar operating systems.
* "Similar operating systems" includes mainly non-profit oriented
* systems for research and education, including but not restricted to
* "NetBSD", "FreeBSD", "Mach" (by CMU).
@@ -35,7 +39,7 @@
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
* SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
- * $Id: mcd.c,v 1.8 1994/02/06 11:33:25 rgrimes Exp $
+ * $Id: mcd.c,v 1.9 1994/02/07 15:46:22 davidg Exp $
*/
static char COPYRIGHT[] = "mcd-driver (C)1993 by H.Veit & B.Moore";
@@ -526,31 +530,51 @@ int mcdsize(dev_t dev)
**************************************************************/
#ifdef NOTDEF
-static char irqs[] = {
+static char
+irqs[] = {
0x00,0x00,0x10,0x20,0x00,0x30,0x00,0x00,
0x00,0x10,0x40,0x50,0x00,0x00,0x00,0x00
};
-static char drqs[] = {
+static char
+drqs[] = {
0x00,0x01,0x00,0x03,0x00,0x05,0x06,0x07,
};
#endif
-static void mcd_configure(struct mcd_data *cd)
+static void
+mcd_configure(struct mcd_data *cd)
{
outb(cd->iobase+mcd_config,cd->config);
}
+/* Wait for non-busy - return 0 on timeout */
+static int
+twiddle_thumbs(int port, int unit, int count, char *whine)
+{
+ int i;
+
+ for (i = 0; i < count; i++) {
+ if (!(inb(port+MCD_FLAGS) & MCD_ST_BUSY)) {
+ return 1;
+ }
+ }
+#ifdef MCD_TO_WARNING_ON
+ printf("mcd%d: timeout %s\n", unit, whine);
+#endif
+ return 0;
+}
+
/* check to see if a Mitsumi CD-ROM is attached to the ISA bus */
-int mcd_probe(struct isa_device *dev)
+int
+mcd_probe(struct isa_device *dev)
{
int port = dev->id_iobase;
int unit = dev->id_unit;
- int i,j;
- int st;
- int check;
- int junk;
+ int i, j;
+ int status;
+ unsigned char stbytes[3];
mcd_data[unit].flags = MCDPROBING;
@@ -562,45 +586,43 @@ int mcd_probe(struct isa_device *dev)
#endif
/* send a reset */
- outb(port+MCD_FLAGS,M_RESET);
- DELAY(3000);
-
- for (j=3; j != 0; j--) {
-
- /* get any pending garbage (old data) and throw away...*/
- for (i=10; i != 0; i--) {
- inb(port+MCD_DATA);
- }
-
- DELAY (2000);
- outb(port+MCD_DATA,MCD_CMDCONTINFO);
- for (i = 0; i < 30000; i++) {
- if ((inb(port+MCD_FLAGS) & M_STATUS_AVAIL) == M_STATUS_AVAIL)
- {
- DELAY (600);
- st = inb(port+MCD_DATA);
- DELAY (500);
- check = inb(port+MCD_DATA);
- DELAY (500);
- junk = inb(port+MCD_DATA); /* What is byte used for?!?!? */
-
- if (check == 'M') {
-#ifdef DEBUG
- printf("Mitsumi drive detected\n");
-#endif
- return 4;
- } else {
- printf("Mitsumi drive NOT detected\n");
- return 0;
- }
- }
- }
- }
- return 0;
+ outb(port+MCD_FLAGS, M_RESET);
+
+ /*
+ * delay awhile by getting any pending garbage (old data) and
+ * throwing it away.
+ */
+ for (i = 1000000; i != 0; i--) {
+ inb(port+MCD_FLAGS);
+ }
+
+ /* Get status */
+ outb(port+MCD_DATA, MCD_CMDGETSTAT);
+ if (!twiddle_thumbs(port, unit, 1000000, "getting status")) {
+ return 0; /* Timeout */
+ }
+ status = inb(port+MCD_DATA);
+
+ /* Get version information */
+ outb(port+MCD_DATA, MCD_CMDCONTINFO);
+ for (j = 0; j < 3; j++) {
+ if (!twiddle_thumbs(port, unit, 3000, "getting version info")) {
+ return 0;
+ }
+ stbytes[j] = (inb(port+MCD_DATA) & 0xFF);
+ }
+ printf("mcd%d: version information is %x %c %x\n", unit,
+ stbytes[0], stbytes[1], stbytes[2]);
+ if (stbytes[1] >= 4) {
+ outb(port+MCD_CTRL, M_PICKLE);
+ printf("mcd%d: Adjusted for newer drive model\n", unit);
+ }
+ return 4;
}
-static int mcd_waitrdy(int port,int dly)
+static int
+mcd_waitrdy(int port,int dly)
{
int i;
@@ -613,7 +635,8 @@ static int mcd_waitrdy(int port,int dly)
return -1;
}
-static int mcd_getreply(int unit,int dly)
+static int
+mcd_getreply(int unit,int dly)
{
int i;
struct mcd_data *cd = mcd_data + unit;
@@ -631,7 +654,8 @@ static int mcd_getreply(int unit,int dly)
return inb(port+mcd_status) & 0xFF;
}
-static int mcd_getstat(int unit,int sflg)
+static int
+mcd_getstat(int unit,int sflg)
{
int i;
struct mcd_data *cd = mcd_data + unit;
@@ -649,7 +673,8 @@ static int mcd_getstat(int unit,int sflg)
return cd->status;
}
-static void mcd_setflags(int unit, struct mcd_data *cd)
+static void
+mcd_setflags(int unit, struct mcd_data *cd)
{
/* check flags */
if (cd->status & (MCDDSKCHNG|MCDDOOROPEN)) {
@@ -665,13 +690,13 @@ static void mcd_setflags(int unit, struct mcd_data *cd)
#endif
}
-static int mcd_get(int unit, char *buf, int nmax)
+static int
+mcd_get(int unit, char *buf, int nmax)
{
int port = mcd_data[unit].iobase;
int i,k;
for (i=0; i<nmax; i++) {
-
/* wait for data */
if ((k = mcd_getreply(unit,DELAY_GETREPLY)) < 0) {
#ifdef MCD_TO_WARNING_ON
@@ -684,7 +709,8 @@ static int mcd_get(int unit, char *buf, int nmax)
return i;
}
-static int mcd_send(int unit, int cmd,int nretrys)
+static int
+mcd_send(int unit, int cmd,int nretrys)
{
int i,k;
int port = mcd_data[unit].iobase;
@@ -692,8 +718,9 @@ static int mcd_send(int unit, int cmd,int nretrys)
/*MCD_TRACE("mcd_send: command = 0x%x\n",cmd,0,0,0);*/
for (i=0; i<nretrys; i++) {
outb(port+mcd_command, cmd);
- if ((k=mcd_getstat(unit,0)) != -1)
+ if ((k=mcd_getstat(unit,0)) != -1) {
break;
+ }
}
if (i == nretrys) {
printf("mcd%d: mcd_send retry cnt exceeded\n",unit);
@@ -703,17 +730,20 @@ static int mcd_send(int unit, int cmd,int nretrys)
return 0;
}
-static int bcd2bin(bcd_t b)
+static int
+bcd2bin(bcd_t b)
{
return (b >> 4) * 10 + (b & 15);
}
-static bcd_t bin2bcd(int b)
+static bcd_t
+bin2bcd(int b)
{
return ((b / 10) << 4) | (b % 10);
}
-static void hsg2msf(int hsg, bcd_t *msf)
+static void
+hsg2msf(int hsg, bcd_t *msf)
{
hsg += 150;
M_msf(msf) = bin2bcd(hsg / 4500);
@@ -722,14 +752,16 @@ static void hsg2msf(int hsg, bcd_t *msf)
F_msf(msf) = bin2bcd(hsg % 75);
}
-static int msf2hsg(bcd_t *msf)
+static int
+msf2hsg(bcd_t *msf)
{
return (bcd2bin(M_msf(msf)) * 60 +
bcd2bin(S_msf(msf))) * 75 +
bcd2bin(F_msf(msf)) - 150;
}
-static int mcd_volinfo(int unit)
+static int
+mcd_volinfo(int unit)
{
struct mcd_data *cd = mcd_data + unit;
int i;
@@ -783,7 +815,8 @@ mcdintr(unit)
*/
static struct mcd_mbx *mbxsave;
-static void mcd_doread(int state, struct mcd_mbx *mbxin)
+static void
+mcd_doread(int state, struct mcd_mbx *mbxin)
{
struct mcd_mbx *mbx = (state!=MCD_S_BEGIN) ? mbxsave : mbxin;
int unit = mbx->unit;
@@ -805,17 +838,20 @@ loop:
/* get status */
outb(port+mcd_command, MCD_CMDGETSTAT);
mbx->count = RDELAY_WAITSTAT;
- timeout((timeout_func_t)mcd_doread,(caddr_t)MCD_S_WAITSTAT,hz/100); /* XXX */
+ timeout((timeout_func_t)mcd_doread,
+ (caddr_t)MCD_S_WAITSTAT,hz/100); /* XXX */
return;
case MCD_S_WAITSTAT:
untimeout((timeout_func_t)mcd_doread,(caddr_t)MCD_S_WAITSTAT);
if (mbx->count-- >= 0) {
if (inb(port+mcd_xfer) & MCD_ST_BUSY) {
- timeout((timeout_func_t)mcd_doread,(caddr_t)MCD_S_WAITSTAT,hz/100); /* XXX */
+ timeout((timeout_func_t)mcd_doread,
+ (caddr_t)MCD_S_WAITSTAT,hz/100); /* XXX */
return;
}
mcd_setflags(unit,cd);
- MCD_TRACE("got WAITSTAT delay=%d\n",RDELAY_WAITSTAT-mbx->count,0,0,0);
+ MCD_TRACE("got WAITSTAT delay=%d\n",
+ RDELAY_WAITSTAT-mbx->count,0,0,0);
/* reject, if audio active */
if (cd->status & MCDAUDIOBSY) {
printf("mcd%d: audio is active\n",unit);
@@ -835,7 +871,8 @@ loop:
mcd_put(port+mcd_command, MCD_CMDSETMODE);
mcd_put(port+mcd_command, rm);
- timeout((timeout_func_t)mcd_doread,(caddr_t)MCD_S_WAITMODE,hz/100); /* XXX */
+ timeout((timeout_func_t)mcd_doread,
+ (caddr_t)MCD_S_WAITMODE,hz/100); /* XXX */
return;
} else {
#ifdef MCD_TO_WARNING_ON
@@ -857,7 +894,8 @@ loop:
return;
}
mcd_setflags(unit,cd);
- MCD_TRACE("got WAITMODE delay=%d\n",RDELAY_WAITMODE-mbx->count,0,0,0);
+ MCD_TRACE("got WAITMODE delay=%d\n",
+ RDELAY_WAITMODE-mbx->count,0,0,0);
/* for first block */
mbx->nblk = (bp->b_bcount + (mbx->sz-1)) / mbx->sz;
mbx->skip = 0;
@@ -866,7 +904,8 @@ nextblock:
blknum = (bp->b_blkno / (mbx->sz/DEV_BSIZE))
+ mbx->p_offset + mbx->skip/mbx->sz;
- MCD_TRACE("mcd_doread: read blknum=%d for bp=0x%x\n",blknum,bp,0,0);
+ MCD_TRACE("mcd_doread: read blknum=%d for bp=0x%x\n",
+ blknum,bp,0,0);
/* build parameter block */
hsg2msf(blknum,rbuf.start_msf);
@@ -880,14 +919,16 @@ nextblock:
mcd_put(port+mcd_command,0);
mcd_put(port+mcd_command,1);
mbx->count = RDELAY_WAITREAD;
- timeout((timeout_func_t)mcd_doread,(caddr_t)MCD_S_WAITREAD,hz/100); /* XXX */
+ timeout((timeout_func_t)mcd_doread,
+ (caddr_t)MCD_S_WAITREAD,hz/100); /* XXX */
return;
case MCD_S_WAITREAD:
untimeout((timeout_func_t)mcd_doread,(caddr_t)MCD_S_WAITREAD);
if (mbx->count-- > 0) {
k = inb(port+mcd_xfer);
if ((k & 2)==0) {
- MCD_TRACE("got data delay=%d\n",RDELAY_WAITREAD-mbx->count,0,0,0);
+ MCD_TRACE("got data delay=%d\n",
+ RDELAY_WAITREAD-mbx->count,0,0,0);
/* data is ready */
addr = bp->b_un.b_addr + mbx->skip;
outb(port+mcd_ctl2,0x04); /* XXX */
@@ -910,7 +951,8 @@ nextblock:
}
if ((k & 4)==0)
mcd_getstat(unit,0);
- timeout((timeout_func_t)mcd_doread,(caddr_t)MCD_S_WAITREAD,hz/100); /* XXX */
+ timeout((timeout_func_t)mcd_doread,
+ (caddr_t)MCD_S_WAITREAD,hz/100); /* XXX */
return;
} else {
#ifdef MCD_TO_WARNING_ON
@@ -950,7 +992,8 @@ readerr:
}
#ifndef MCDMINI
-static int mcd_setmode(int unit, int mode)
+static int
+mcd_setmode(int unit, int mode)
{
struct mcd_data *cd = mcd_data + unit;
int port = cd->iobase;
@@ -967,12 +1010,14 @@ static int mcd_setmode(int unit, int mode)
return -1;
}
-static int mcd_toc_header(int unit, struct ioc_toc_header *th)
+static int
+mcd_toc_header(int unit, struct ioc_toc_header *th)
{
struct mcd_data *cd = mcd_data + unit;
- if (mcd_volinfo(unit) < 0)
+ if (mcd_volinfo(unit) < 0) {
return ENXIO;
+ }
th->len = msf2hsg(cd->volinfo.vol_msf);
th->starting_track = bcd2bin(cd->volinfo.trk_low);
@@ -981,7 +1026,8 @@ static int mcd_toc_header(int unit, struct ioc_toc_header *th)
return 0;
}
-static int mcd_read_toc(int unit)
+static int
+mcd_read_toc(int unit)
{
struct mcd_data *cd = mcd_data + unit;
struct ioc_toc_header th;
@@ -989,21 +1035,27 @@ static int mcd_read_toc(int unit)
int rc, trk, idx, retry;
/* Only read TOC if needed */
- if (cd->flags & MCDTOC) return 0;
+ if (cd->flags & MCDTOC) {
+ return 0;
+ }
printf("mcd%d: reading toc header\n", unit);
- if (mcd_toc_header(unit, &th) != 0)
+ if (mcd_toc_header(unit, &th) != 0) {
return ENXIO;
+ }
printf("mcd%d: stopping play\n", unit);
- if ((rc=mcd_stop(unit)) != 0)
+ if ((rc=mcd_stop(unit)) != 0) {
return rc;
+ }
/* try setting the mode twice */
- if (mcd_setmode(unit, MCD_MD_TOC) != 0)
+ if (mcd_setmode(unit, MCD_MD_TOC) != 0) {
return EIO;
- if (mcd_setmode(unit, MCD_MD_TOC) != 0)
+ }
+ if (mcd_setmode(unit, MCD_MD_TOC) != 0) {
return EIO;
+ }
printf("mcd%d: get_toc reading qchannel info\n",unit);
for(trk=th.starting_track; trk<=th.ending_track; trk++)
@@ -1013,18 +1065,21 @@ static int mcd_read_toc(int unit)
{
if (mcd_getqchan(unit, &q) < 0) break;
idx = bcd2bin(q.idx_no);
- if (idx>0 && idx < MCD_MAXTOCS && q.trk_no==0)
- if (cd->toc[idx].idx_no == 0)
- {
+ if (idx>0 && idx < MCD_MAXTOCS && q.trk_no==0) {
+ if (cd->toc[idx].idx_no == 0) {
cd->toc[idx] = q;
trk--;
}
+ }
}
- if (mcd_setmode(unit, MCD_MD_COOKED) != 0)
+ if (mcd_setmode(unit, MCD_MD_COOKED) != 0) {
return EIO;
+ }
- if (trk != 0) return ENXIO;
+ if (trk != 0) {
+ return ENXIO;
+ }
/* add a fake last+1 */
idx = th.ending_track + 1;
@@ -1040,11 +1095,11 @@ static int mcd_read_toc(int unit)
return 0;
}
-static int mcd_toc_entry(int unit, struct ioc_read_toc_entry *te)
+static int
+mcd_toc_entry(int unit, struct ioc_read_toc_entry *te)
{
struct mcd_data *cd = mcd_data + unit;
- struct ret_toc
- {
+ struct ret_toc {
struct ioc_toc_header th;
struct cd_toc_entry rt;
} ret_toc;
@@ -1052,33 +1107,39 @@ static int mcd_toc_entry(int unit, struct ioc_read_toc_entry *te)
int rc, i;
/* Make sure we have a valid toc */
- if ((rc=mcd_read_toc(unit)) != 0)
+ if ((rc=mcd_read_toc(unit)) != 0) {
return rc;
+ }
/* find the toc to copy*/
i = te->starting_track;
- if (i == MCD_LASTPLUS1)
+ if (i == MCD_LASTPLUS1) {
i = bcd2bin(cd->volinfo.trk_high) + 1;
+ }
/* verify starting track */
if (i < bcd2bin(cd->volinfo.trk_low) ||
- i > bcd2bin(cd->volinfo.trk_high)+1)
+ i > bcd2bin(cd->volinfo.trk_high)+1) {
return EINVAL;
+ }
/* do we have room */
if (te->data_len < sizeof(struct ioc_toc_header) +
- sizeof(struct cd_toc_entry)) return EINVAL;
+ sizeof(struct cd_toc_entry)) {
+ return EINVAL;
+ }
/* Copy the toc header */
- if (mcd_toc_header(unit, &th) < 0) return EIO;
+ if (mcd_toc_header(unit, &th) < 0) {
+ return EIO;
+ }
ret_toc.th = th;
/* copy the toc data */
ret_toc.rt.control = cd->toc[i].ctrl_adr;
ret_toc.rt.addr_type = te->address_format;
ret_toc.rt.track = i;
- if (te->address_format == CD_MSF_FORMAT)
- {
+ if (te->address_format == CD_MSF_FORMAT) {
ret_toc.rt.addr.addr[1] = cd->toc[i].hd_pos_msf[0];
ret_toc.rt.addr.addr[2] = cd->toc[i].hd_pos_msf[1];
ret_toc.rt.addr.addr[3] = cd->toc[i].hd_pos_msf[2];
@@ -1091,34 +1152,41 @@ static int mcd_toc_entry(int unit, struct ioc_read_toc_entry *te)
return 0;
}
-static int mcd_stop(int unit)
+static int
+mcd_stop(int unit)
{
struct mcd_data *cd = mcd_data + unit;
- if (mcd_send(unit, MCD_CMDSTOPAUDIO, MCD_RETRYS) < 0)
+ if (mcd_send(unit, MCD_CMDSTOPAUDIO, MCD_RETRYS) < 0) {
return ENXIO;
+ }
cd->audio_status = CD_AS_PLAY_COMPLETED;
return 0;
}
-static int mcd_getqchan(int unit, struct mcd_qchninfo *q)
+static int
+mcd_getqchan(int unit, struct mcd_qchninfo *q)
{
struct mcd_data *cd = mcd_data + unit;
- if (mcd_send(unit, MCD_CMDGETQCHN, MCD_RETRYS) < 0)
+ if (mcd_send(unit, MCD_CMDGETQCHN, MCD_RETRYS) < 0) {
return -1;
- if (mcd_get(unit, (char *) q, sizeof(struct mcd_qchninfo)) < 0)
+ }
+ if (mcd_get(unit, (char *) q, sizeof(struct mcd_qchninfo)) < 0) {
return -1;
- if (cd->debug)
- printf("mcd%d: qchannel ctl=%d, t=%d, i=%d, ttm=%d:%d.%d dtm=%d:%d.%d\n",
+ }
+ if (cd->debug) {
+ printf("mcd%d: qchannel ctl=%d, t=%d, i=%d, ttm=%d:%d.%d dtm=%d:%d.%d\n",
unit,
q->ctrl_adr, q->trk_no, q->idx_no,
q->trk_size_msf[0], q->trk_size_msf[1], q->trk_size_msf[2],
q->trk_size_msf[0], q->trk_size_msf[1], q->trk_size_msf[2]);
+ }
return 0;
}
-static int mcd_subchan(int unit, struct ioc_read_subchannel *sc)
+static int
+mcd_subchan(int unit, struct ioc_read_subchannel *sc)
{
struct mcd_data *cd = mcd_data + unit;
struct mcd_qchninfo q;
@@ -1127,21 +1195,28 @@ static int mcd_subchan(int unit, struct ioc_read_subchannel *sc)
printf("mcd%d: subchan af=%d, df=%d\n", unit,
sc->address_format,
sc->data_format);
- if (sc->address_format != CD_MSF_FORMAT) return EIO;
- if (sc->data_format != CD_CURRENT_POSITION) return EIO;
-
- if (mcd_getqchan(unit, &q) < 0) return EIO;
+ if (sc->address_format != CD_MSF_FORMAT) {
+ return EIO;
+ }
+ if (sc->data_format != CD_CURRENT_POSITION) {
+ return EIO;
+ }
+ if (mcd_getqchan(unit, &q) < 0) {
+ return EIO;
+ }
data.header.audio_status = cd->audio_status;
data.what.position.data_format = CD_MSF_FORMAT;
data.what.position.track_number = bcd2bin(q.trk_no);
- if (copyout(&data, sc->data, sizeof(struct cd_sub_channel_info))!=0)
+ if (copyout(&data, sc->data, sizeof(struct cd_sub_channel_info))!=0) {
return EFAULT;
+ }
return 0;
}
-static int mcd_playtracks(int unit, struct ioc_play_track *pt)
+static int
+mcd_playtracks(int unit, struct ioc_play_track *pt)
{
struct mcd_data *cd = mcd_data + unit;
struct mcd_read2 pb;
@@ -1149,14 +1224,16 @@ static int mcd_playtracks(int unit, struct ioc_play_track *pt)
int z = pt->end_track;
int rc;
- if ((rc = mcd_read_toc(unit)) != 0) return rc;
-
+ if ((rc = mcd_read_toc(unit)) != 0) {
+ return rc;
+ }
printf("mcd%d: playtracks from %d:%d to %d:%d\n", unit,
a, pt->start_index, z, pt->end_index);
if (a < cd->volinfo.trk_low || a > cd->volinfo.trk_high || a > z ||
- z < cd->volinfo.trk_low || z > cd->volinfo.trk_high)
+ z < cd->volinfo.trk_low || z > cd->volinfo.trk_high) {
return EINVAL;
+ }
pb.start_msf[0] = cd->toc[a].hd_pos_msf[0];
pb.start_msf[1] = cd->toc[a].hd_pos_msf[1];
@@ -1168,15 +1245,15 @@ static int mcd_playtracks(int unit, struct ioc_play_track *pt)
return mcd_play(unit, &pb);
}
-static int mcd_play(int unit, struct mcd_read2 *pb)
+static int
+mcd_play(int unit, struct mcd_read2 *pb)
{
struct mcd_data *cd = mcd_data + unit;
int port = cd->iobase;
int retry, st;
cd->lastpb = *pb;
- for(retry=0; retry<MCD_RETRYS; retry++)
- {
+ for(retry=0; retry<MCD_RETRYS; retry++) {
outb(port+mcd_command, MCD_CMDREAD2);
outb(port+mcd_command, pb->start_msf[0]);
outb(port+mcd_command, pb->start_msf[1]);
@@ -1184,31 +1261,38 @@ static int mcd_play(int unit, struct mcd_read2 *pb)
outb(port+mcd_command, pb->end_msf[0]);
outb(port+mcd_command, pb->end_msf[1]);
outb(port+mcd_command, pb->end_msf[2]);
- if ((st=mcd_getstat(unit, 0)) != -1) break;
+ if ((st=mcd_getstat(unit, 0)) != -1) {
+ break;
+ }
}
- if (cd->debug)
- printf("mcd%d: mcd_play retry=%d, status=%d\n", unit, retry, st);
- if (st == -1) return ENXIO;
+ if (cd->debug) {
+ printf("mcd%d: mcd_play retry=%d, status=%d\n", unit, retry, st);
+ }
+ if (st == -1) {
+ return ENXIO;
+ }
cd->audio_status = CD_AS_PLAY_IN_PROGRESS;
return 0;
}
-static int mcd_pause(int unit)
+static int
+mcd_pause(int unit)
{
struct mcd_data *cd = mcd_data + unit;
struct mcd_qchninfo q;
int rc;
/* Verify current status */
- if (cd->audio_status != CD_AS_PLAY_IN_PROGRESS)
- {
+ if (cd->audio_status != CD_AS_PLAY_IN_PROGRESS) {
printf("mcd%d: pause attempted when not playing\n", unit);
return EINVAL;
}
/* Get the current position */
- if (mcd_getqchan(unit, &q) < 0) return EIO;
+ if (mcd_getqchan(unit, &q) < 0) {
+ return EIO;
+ }
/* Copy it into lastpb */
cd->lastpb.start_msf[0] = q.hd_pos_msf[0];
@@ -1216,18 +1300,23 @@ static int mcd_pause(int unit)
cd->lastpb.start_msf[2] = q.hd_pos_msf[2];
/* Stop playing */
- if ((rc=mcd_stop(unit)) != 0) return rc;
+ if ((rc=mcd_stop(unit)) != 0) {
+ return rc;
+ }
/* Set the proper status and exit */
cd->audio_status = CD_AS_PLAY_PAUSED;
return 0;
}
-static int mcd_resume(int unit)
+static int
+mcd_resume(int unit)
{
struct mcd_data *cd = mcd_data + unit;
- if (cd->audio_status != CD_AS_PLAY_PAUSED) return EINVAL;
+ if (cd->audio_status != CD_AS_PLAY_PAUSED) {
+ return EINVAL;
+ }
return mcd_play(unit, &cd->lastpb);
}
#endif /*!MCDMINI*/
OpenPOWER on IntegriCloud