ref: 71292834bbafcf6bc409cfd7691f9e6650df025b
dir: /os/pc/devmpeg.c/
/*
* Boffin MPEG decoder
*/
#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "../port/error.h"
#include "zoran.h"
#include "crystal.h"
#include "io.h"
enum
{
CPUACCCTRL = 0x20, /* Trident Window Chip control registers */
CPUACCMD = 0x21,
BNKADR = 0x22,
SYSCONFIG = 0x23,
VGACOMP = 0x24,
VGAMASK = 0x25,
VIDCOMPL = 0x26,
VIDCOMPH = 0x27,
MOS = 0x28,
DISPCTRL = 0x29,
CAPCTRL = 0x2a,
OVLKT = 0x2b,
OVLWINHSTRT = 0x2c,
OVLWINVSTRT = 0x2d,
OVLWINHEND = 0x2e,
OVLWINVEND = 0x2f,
RESERVED1 = 0x30,
RESERVED2 = 0x31,
DISPWINVSTRT1 = 0x32,
DISPWINVSTRT2 = 0x33,
DISPWINVEND = 0x34,
DISPWINHSTRT1 = 0x35,
DISPWINHSTRT2 = 0x36,
DISPWINHEND = 0x37,
CAPWINVSTRT = 0x38,
CAPWINHSTRT = 0x39,
CAPWINVMF = 0x3a,
CAPWINHMF = 0x3b,
RESERVED3 = 0x3c,
CAPMASK = 0x3d,
BNKPOLATION = 0x3e,
SYNCPOL = 0x3f,
DISPVTOTAL = 0x40,
DISPHTOTAL = 0x41,
DISPVSTRT = 0x42,
DISPVEND = 0x43,
DISPHSTRT = 0x44,
DISPHEND = 0x45,
DISPSYNCW = 0x46,
DISPCRTCCTRL = 0x47,
CAPVTOTAL = 0x48,
CAPHTOTAL = 0x49,
CAPVSTRT = 0x4a,
CAPVEND = 0x4b,
CAPHSTRT = 0x4c,
CAPHEND = 0x4d,
CAPSYNCW = 0x4e,
CAPCRTCCTRL = 0x4f,
VIDLUTDACRW = 0x50,
VIDLUTDACRW0 = (VIDLUTDACRW),
VIDLUTDACRW1 = (VIDLUTDACRW+1),
VIDLUTDACRW2 = (VIDLUTDACRW+2),
VIDLUTDACRW3 = (VIDLUTDACRW+3),
VIDLUTDACRW4 = (VIDLUTDACRW+4),
VIDLUTDACRW5 = (VIDLUTDACRW+5),
VIDLUTDACRW6 = (VIDLUTDACRW+6),
VIDLUTDACRW7 = (VIDLUTDACRW+7),
VGALUTDACRW = 0x58,
VGALUTDACRW0 = (VGALUTDACRW),
VGALUTDACRW1 = (VGALUTDACRW+1),
VGALUTDACRW2 = (VGALUTDACRW+2),
VGALUTDACRW3 = (VGALUTDACRW+3),
VGALUTDACRW4 = (VGALUTDACRW+4),
VGALUTDACRW5 = (VGALUTDACRW+5),
VGALUTDACRW6 = (VGALUTDACRW+6),
VGALUTDACRW7 = (VGALUTDACRW+7),
HZOOMF = 0x60,
VZOOMF = 0x61,
DELAY1 = 0x62,
DELAY2 = 0x63,
TRILO = 0,
TRIHI = 1,
TRIINDEX = 2,
SCL = 0x02,
SDA = 0x01,
I2CR = 0x2B,
SAA7110 = 0x9c,
WRITE_C = 0x00,
I2DLY = 5,
};
enum
{
ZR36100 = 0x1e0,
ZRIRQ = 15,
ZRDMA = 6,
ZRIDREG = 4, /* offset */
ZRMACH210 = 6, /* offset */
ZRREG0 = 8, /* offset */
ZRREG1 = 10, /* offset */
ZRSR = ZRREG1, /* offset */
ZRRDY = (1<<3),
ZRIDLE = (1<<2),
ZRREG2 = 12, /* offset */
ZRREG3 = 14, /* offset */
SIFwidth = 320,
SIFheight = 240,
IDPCOUNT = 3064,
PMDPCOUNT = 2048,
SVMDPCOUNT = 2048,
HIWAT = 2*128*1024,
DMABLK = 16384,
};
static struct {
int zrport;
int irq;
int dma;
int trport;
} mpegconf;
static char Evmode[] = "video format not supported";
static char Eaudio[] = "invalid audio layer";
static char Earate[] = "bad audio sample rate";
/* Status bits depend on board revision */
static short STDBY;
static short VIDSEL;
static short VSNIRQn;
static short INTENAn;
static short DSPBOOT;
static short DSPRST;
static short MPGRST;
static int machsr;
static int dopen;
static int started;
static int stop;
static int pause;
static int sp2br;
static int sp2cd;
static char properties[] = "video mpeg1,sif\naudio musicam,I musicam,II\n";
static void inittrident(void);
static int initzoran(void);
static void initcrystal(void);
static void mpegintr(Ureg*, void*);
static void setwindow(int, char**);
static void freebufs(void);
static int mkbuf(char*, int);
typedef struct Buf Buf;
struct Buf
{
int nchar;
uchar* ptr;
Buf* link;
uchar data[1];
};
static struct
{
Lock;
int qlen;
Buf* head;
Buf* tail;
Rendez flow;
} bqueue;
static int
zrstatus(void)
{
return ins(mpegconf.zrport+ZRSR) & 0xf;
}
static int
zrwaitrdy(int timo, char *msg)
{
int i;
for(i = 0; i < timo; i++)
if(ins(mpegconf.zrport+ZRSR) & ZRRDY)
return 0;
print("devmpeg: device not ready %s\n", msg);
return 1;
}
static void
zrdma(Buf *b)
{
int n;
n = dmasetup(mpegconf.dma, b->ptr, b->nchar, 0);
b->ptr += n;
b->nchar -= n;
bqueue.qlen -= n;
}
static void
triwr(int reg, int val)
{
outb(mpegconf.trport+TRIINDEX, reg);
outb(mpegconf.trport+TRILO, val);
outb(mpegconf.trport+TRIHI, val>>8);
}
static int
trird(int reg)
{
int v;
outb(mpegconf.trport+TRIINDEX, reg);
v = inb(mpegconf.trport+TRILO);
v |= inb(mpegconf.trport+TRIHI)<<8;
return v;
}
enum
{
Qdir,
Qdata,
Qctl,
};
static Dirtab mpegtab[]=
{
"mpeg", {Qdata, 0}, 0, 0666,
"mpegctl", {Qctl, 0}, 0, 0666,
};
static void
mpegreset(void)
{
ISAConf isa;
mpegconf.zrport = ZR36100;
mpegconf.irq = ZRIRQ;
mpegconf.dma = ZRDMA;
memset(&isa, 0, sizeof(isa));
if(isaconfig("mpeg", 0, &isa) == 0)
return;
if(isa.port)
mpegconf.zrport = isa.port;
if(isa.irq)
mpegconf.irq = isa.irq;
if(isa.dma)
mpegconf.dma = isa.dma;
dmainit(mpegconf.dma, 64*1024);
print("mpeg0: port 0x%uX, irq %d, dma %d\n",
mpegconf.zrport, mpegconf.irq, mpegconf.dma);
mpegconf.trport = mpegconf.zrport+0x100;
intrenable(VectorPIC+mpegconf.irq, mpegintr, 0, BUSUNKNOWN);
}
static void
mpeginit(void)
{
if(mpegconf.trport == 0)
return;
inittrident();
setwindow(0, 0);
}
static Chan*
mpegattach(char *spec)
{
if(mpegconf.trport == 0)
error(Enodev);
return devattach('E', spec);
}
static int
mpegwalk(Chan *c, char *name)
{
return devwalk(c, name, mpegtab, nelem(mpegtab), devgen);
}
static void
mpegstat(Chan *c, char *db)
{
devstat(c, db, mpegtab, nelem(mpegtab), devgen);
}
static Chan*
mpegopen(Chan *c, int omode)
{
switch(c->qid.path) {
default:
break;
case Qdata:
if(dopen)
error(Einuse);
dopen = 1;
break;
}
return devopen(c, omode, mpegtab, nelem(mpegtab), devgen);
}
static void
mpegclose(Chan *c)
{
int i;
switch(c->qid.path) {
default:
break;
case Qdata:
if((c->flag & COPEN) == 0)
break;
if(started) {
for(i = 0; i < 50; i++) {
if(ins(mpegconf.zrport+ZRSR) & ZRIDLE)
break;
tsleep(&up->sleep, return0, 0, 100);
}
}
if(stop != 0)
outs(mpegconf.zrport+ZRREG1, 0x1000);
microdelay(15);
outs(mpegconf.zrport+ZRREG1, 0x8000);
freebufs();
dopen = 0;
}
}
static long
mpegread(Chan *c, void *a, long n, ulong off)
{
switch(c->qid.path & ~CHDIR){
default:
error(Eperm);
case Qdir:
return devdirread(c, a, n, mpegtab, nelem(mpegtab), devgen);
case Qctl:
return readstr(off, a, n, properties);
}
return 0;
}
#define SCALE(a, b) ((((a)<<10)/(b))-1024)
enum
{
CWINVF = 0x3ff,
CWINHF = 0x1da,
};
static void
setwindow(int nf, char **field)
{
int minx, miny, maxx, maxy, width, height;
if(field == 0) {
minx = 0;
miny = 0;
maxx = 0;
maxy = 0;
}
else {
if(nf != 5)
error(Ebadarg);
minx = strtoul(field[1], 0, 0);
miny = strtoul(field[2], 0, 0);
maxx = strtoul(field[3], 0, 0) + 8;
maxy = strtoul(field[4], 0, 0);
}
triwr(OVLWINHSTRT, minx);
triwr(OVLWINVSTRT, miny);
triwr(OVLWINHEND, maxx+12);
triwr(OVLWINVEND, maxy);
width = maxx - minx;
height = maxy - miny;
if(width >= SIFwidth) {
triwr(HZOOMF, SCALE(width, SIFwidth));
triwr(CAPWINHMF, CWINHF);
}
else {
triwr(HZOOMF, SCALE(SIFwidth, SIFwidth));
triwr(CAPWINHMF, width*CWINHF/SIFwidth);
}
if(height >= SIFheight) {
triwr(VZOOMF, SCALE(height, SIFheight));
triwr(CAPWINVMF, CWINVF);
}
else {
triwr(VZOOMF, SCALE(SIFheight, SIFheight));
triwr(CAPWINVMF, height*CWINVF/SIFheight);
}
}
static int
mpegflow(void*)
{
return bqueue.qlen < HIWAT || stop;
}
static int
mkbuf(char *d, int n)
{
Buf *b;
b = malloc(sizeof(Buf)+n);
if(b == 0)
return 0;
memmove(b->data, d, n);
b->ptr = b->data;
b->nchar = n;
b->link = 0;
ilock(&bqueue);
bqueue.qlen += n;
if(bqueue.head)
bqueue.tail->link = b;
else
bqueue.head = b;
bqueue.tail = b;
iunlock(&bqueue);
return 1;
}
static void
freebufs(void)
{
Buf *next;
ilock(&bqueue);
bqueue.qlen = 0;
while(bqueue.head) {
next = bqueue.head->link;
free(bqueue.head);
bqueue.head = next;
}
iunlock(&bqueue);
}
typedef struct Audio Audio;
struct Audio {
int rate;
int cd;
int br;
};
static Audio AudioclkI[] =
{
64000, 0x000000bb, 0x00071797,
96000, 0x0000007d, 0x00071c71,
128000, 0x0000005d, 0x00070de1,
160000, 0x0000004b, 0x00071c71,
192000, 0x0000003e, 0x00070de1,
224000, 0x00000035, 0x00070906,
256000, 0x0000002e, 0x0006fa76,
288000, 0x00000029, 0x0006ff51,
320000, 0x00000025, 0x0007042b,
352000, 0x00000022, 0x00071797,
384000, 0x0000001f, 0x00070de1,
416000, 0x0000001c, 0x0006e70b,
448000, 0x0000001a, 0x0006e70b,
};
static Audio AudioclkII[] =
{
48000, 0x000000fa, 0x00071c71,
56000, 0x000000d6, 0x00071a04,
64000, 0x000000bb, 0x00071797,
80000, 0x00000096, 0x00071c71,
96000, 0x0000007d, 0x00071c71,
112000, 0x0000006b, 0x00071a04,
128000, 0x0000005d, 0x00070de1,
160000, 0x0000004b, 0x00071c71,
192000, 0x0000003e, 0x00070de1,
224000, 0x00000035, 0x00070906,
256000, 0x0000002e, 0x0006fa76,
320000, 0x00000025, 0x0007042b,
384000, 0x0000001f, 0x00070de1,
};
static long
mpegwrite(Chan *c, char *a, long n, vlong)
{
Audio *t;
int i, nf, l, x;
char buf[128], *field[10];
switch(c->qid.path & ~CHDIR) {
case Qctl:
if(n > sizeof(buf)-1)
n = sizeof(buf)-1;
memmove(buf, a, n);
buf[n] = '\0';
nf = getfields(buf, field, nelem(field), 1, " \t\n");
if(nf < 1)
error(Ebadarg);
if(strcmp(field[0], "stop") == 0) {
if(started == 0)
error("not started");
if(pause) {
pause = 0;
outs(mpegconf.zrport+ZRREG1, 0x9000);
}
stop = 1;
outs(mpegconf.zrport+ZRREG1, 0x1000);
microdelay(15);
outs(mpegconf.zrport+ZRREG1, 0x8000);
wakeup(&bqueue.flow);
return n;
}
if(strcmp(field[0], "pause") == 0) {
if(started == 0)
error("not started");
if(pause == 0) {
pause = 1;
outs(mpegconf.zrport+ZRREG1, 0x1000);
}
else {
pause = 0;
outs(mpegconf.zrport+ZRREG1, 0x9000);
}
return n;
}
if(strcmp(field[0], "window") == 0) {
setwindow(nf, field);
return n;
}
if(strcmp(field[0], "audio") == 0) {
if(nf < 3)
error(Ebadarg);
t = 0;
if(strcmp(field[1], "musicam,I") == 0)
t = AudioclkI;
else
if(strcmp(field[1], "musicam,II") == 0)
t = AudioclkII;
else
error(Eaudio);
x = strtoul(field[2], 0, 0);
for(i = 0; t[i].rate != 0; i++) {
if(t[i].rate == x) {
sp2cd = t[i].cd;
sp2br = t[i].br;
return n;
}
}
error(Earate);
}
if(strcmp(field[0], "video") == 0) {
if(nf != 3)
error(Ebadarg);
if(strcmp(field[1], "iso11172") != 0)
error(Evmode);
if(strcmp(field[2], "mpeg1,sif") != 0)
error(Evmode);
return n;
}
if(strcmp(field[0], "init") == 0) {
inittrident();
for(i = 0; i < 3; i++)
if(initzoran() != -1)
break;
initcrystal();
started = 0;
stop = 0;
pause = 0;
return n;
}
error(Ebadarg);
case Qdata:
if(n & 1)
error("odd write");
while(!mpegflow(0))
sleep(&bqueue.flow, mpegflow, 0);
if(stop)
error("stopped");
x = n;
while(x) {
l = x;
if(l > DMABLK)
l = DMABLK;
if(mkbuf(a, l) == 0)
error(Enomem);
x -= l;
a += l;
}
if(started || bqueue.qlen < (HIWAT*3)/4)
break;
zrdma(bqueue.head);
outs(mpegconf.zrport+ZRREG1, 0x0000);
outs(mpegconf.zrport+ZRREG1, 0x0000);
started = 1;
break;
default:
error(Ebadusefd);
}
return n;
}
Dev mpegdevtab = {
'E',
"mpeg",
mpegreset,
mpeginit,
mpegattach,
devdetach,
devclone,
mpegwalk,
mpegstat,
mpegopen,
devcreate,
mpegclose,
mpegread,
devbread,
mpegwrite,
devbwrite,
devremove,
devwstat,
};
static void
initctl(void)
{
int boardid;
static int done;
if(done)
return;
boardid = ins(mpegconf.zrport+ZRIDREG);
if(boardid == 0xE3E3) { /* REV c/d */
STDBY = 0x0000;
VIDSEL = 0x2020;
VSNIRQn = 0x1010;
INTENAn = 0x0808;
DSPBOOT = 0x0404;
DSPRST = 0x0202;
MPGRST = 0x0101;
}
else { /* REV b */
STDBY = 0x0404;
VIDSEL = 0x1010;
VSNIRQn = 0x8080;
INTENAn = 0x4040;
DSPBOOT = 0x0202;
DSPRST = 0x0101;
MPGRST = 0x2020;
}
done = 1;
}
/*
* nbl (reg 0x1[ab]) was 0x0022, nblf (reg 1[cd]) was 0x0006
*/
static uchar
zrparam[] =
{
/* 00 */ 0xEF, 0x01, 0x01, 0x01, 0x80, 0x0E, 0x31, 0x00,
/* 08 */ 0x01, 0x60, 0x00, 0x00, 0x03, 0x5A, 0x00, 0x7A,
/* 10 */ 0x00, 0x10, 0x00, 0x08, 0x00, 0xF0, 0x00, 0x00,
/* 18 */ 0x02, 0x0D, 0x00, 0x1e, 0x00, 0x0a, 0x00, 0x02,
/* 20 */ 0x40, 0x06, 0x80, 0x00, 0x80, 0x00, 0x05, 0x9B,
/* 28 */ 0x07, 0x16, 0xFD, 0x25, 0xFE, 0xA0, 0x00, 0x00,
/* 30 */ 0x00, 0x07, 0x0d, 0xe1, 0x00, 0x00, 0x00, 0x3E,
/* 38 */ 0x00, 0x00, 0x09, 0x51, 0x00, 0x00, 0xCD, 0xFE,
/* 40 */ 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/* 48 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/* 50 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/* 58 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/* 60 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/* 68 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/* 70 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
/* 78 */ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
};
static int
initzoran(void)
{
int i, nbytes, zrs;
initctl();
freebufs();
machsr = DSPRST|VSNIRQn;
outs(mpegconf.zrport+ZRMACH210, machsr);
microdelay(4000);
machsr |= STDBY;
outs(mpegconf.zrport+ZRMACH210, machsr);
microdelay(4000);
machsr |= MPGRST;
outs(mpegconf.zrport+ZRMACH210, machsr);
microdelay(4000);
machsr &= ~MPGRST;
outs(mpegconf.zrport+ZRMACH210, machsr);
microdelay(4000);
machsr |= MPGRST;
outs(mpegconf.zrport+ZRMACH210, machsr);
microdelay(4000);
if(zrwaitrdy(2000, "load IDP"))
return -1;
for(i = 0; i < IDPCOUNT; i++)
outb(mpegconf.zrport+ZRREG2, zrmpeg1[i]);
if(((zrs = zrstatus()) & 3) != 3) {
/* print("devmpeg: error loading IDP sr=%2.2ux\n", zrs); */
USED(zrs);
return -1;
}
if(zrwaitrdy(2000, "load PMDP"))
return -1;
for(i = 0; i < PMDPCOUNT; i++)
outb(mpegconf.zrport+ZRREG3, zrmpeg2[i]);
if(((zrs = zrstatus()) & 3) != 3) {
/* print("devmpeg: error loading PMDP sr=%2.2ux\n", zrs); */
USED(zrs);
return -1;
}
zrparam[0x36] = sp2cd>>8;
zrparam[0x37] = sp2cd>>0;
zrparam[0x31] = sp2br>>16;
zrparam[0x32] = sp2br>>8;
zrparam[0x33] = sp2br>>0;
nbytes = 16;
for(i = 0; i < 128; i++) {
if(nbytes >= 16) {
if(zrwaitrdy(2000, "load parameters"))
return -1;
nbytes = 0;
}
outb(mpegconf.zrport+ZRREG0, zrparam[i]);
nbytes++;
}
if(zrwaitrdy(2000, "load SVMDP"))
return -1;
for(i = 0; i < SVMDPCOUNT; i++)
outb(mpegconf.zrport+ZRREG3, zrmpeg3s[i]);
if(((zrs = zrstatus()) & 3) != 3) {
/* print("devmpeg: error loading SVMDP sr=%2.2ux\n", zrs); */
USED(zrs);
return -1;
}
return 0;
}
static struct
{
short reg;
ushort val;
} trireg[] =
{
0x20, 0x0400,
0x21, 0x00e9,
0x22, 0x0000,
0x23, 0x07ee,
0x24, 0x0005,
0x25, 0xff00,
0x26, 0x0000,
0x27, 0x7fff,
0x28, 0x0004,
0x29, 0x88a0,
0x2a, 0x0011,
0x2b, 0x8540,
0x2c, 0x00c4,
0x2d, 0x00ac,
0x2e, 0x020f,
0x2f, 0x019d,
0x30, 0x00bd,
0x31, 0x00ff,
0x32, 0x0000,
0x33, 0x0000,
0x34, 0x03ff,
0x35, 0x0000,
0x36, 0x0000,
0x37, 0x03ff,
0x38, 0x0000,
0x39, 0x0000,
0x3a, 0x03ff,
0x3b, 0x01da,
0x3c, 0xe8ce,
0x3d, 0x2ac0,
0x3e, 0x891f,
0x3f, 0x3e25,
0x40, 0x03ff,
0x41, 0x01ff,
0x42, 0x001f,
0x43, 0x01ff,
0x44, 0x003b,
0x45, 0x0186,
0x46, 0x1d06,
0x47, 0x1a4f,
0x48, 0x020d,
0x49, 0x01ad,
0x4a, 0x001b,
0x4b, 0x01fd,
0x4c, 0x003a,
0x4d, 0x034b,
0x4e, 0x2006,
0x4f, 0x0083,
0x50, 0xef08,
0x51, 0xef3a,
0x52, 0xefff,
0x53, 0xef08,
0x54, 0xef08,
0x55, 0xef15,
0x56, 0xefc0,
0x57, 0xef08,
0x58, 0xefef,
0x59, 0xefef,
0x5a, 0xefef,
0x5b, 0xefef,
0x5c, 0xefef,
0x5d, 0xefef,
0x5e, 0xefef,
0x5f, 0xefef,
0x60, 0x0000,
0x61, 0x0004,
0x62, 0x0020,
0x63, 0x8080,
0x64, 0x0300,
-1
};
static void
clrI2C(uchar b)
{
uchar t;
outb(mpegconf.trport+TRIINDEX, I2CR);
t = inb(mpegconf.trport+TRIHI);
t &= ~b;
outb(mpegconf.trport+TRIHI, t);
}
static void
setI2C(uchar b)
{
uchar t;
outb(mpegconf.trport+TRIINDEX, I2CR);
t = inb(mpegconf.trport+TRIHI);
t |= b;
outb(mpegconf.trport+TRIHI, t);
}
static void
startI2C(void)
{
setI2C(SDA);
setI2C(SCL);
microdelay(I2DLY);
clrI2C(SDA);
microdelay(I2DLY);
clrI2C(SCL);
microdelay(I2DLY);
}
static void
endI2C(void)
{
clrI2C(SDA);
clrI2C(SCL);
microdelay(I2DLY);
setI2C(SCL);
microdelay(I2DLY);
setI2C(SDA);
microdelay(I2DLY);
}
static void
wrI2Cbit(uchar b)
{
clrI2C(SDA);
clrI2C(SCL);
microdelay(I2DLY);
if(b & 1) {
setI2C(SDA);
microdelay(I2DLY);
setI2C(SCL);
microdelay(I2DLY);
clrI2C(SCL);
microdelay(I2DLY);
clrI2C(SDA);
microdelay(I2DLY);
}
else {
setI2C(SCL);
microdelay(I2DLY);
clrI2C(SCL);
microdelay(I2DLY);
}
}
static void
wrI2CB(unsigned char data)
{
int i;
for(i = 0; i < 8; i++)
wrI2Cbit(data >>(7-i));
}
static int
rdI2CBit(void)
{
int bit = 1;
setI2C(SDA);
clrI2C(SCL);
setI2C(SCL);
outb(mpegconf.trport+TRIINDEX, I2CR);
if(inb(mpegconf.trport+TRIHI) & SDA)
bit = 0;
clrI2C(SDA);
clrI2C(SCL);
return bit;
}
static int
wrI2CD(uchar data)
{
int r;
ulong s;
s = splhi();
wrI2CB(data);
r = rdI2CBit();
splx(s);
return r;
}
static uchar
setupSAA7110[] =
{
/* Digital */
0x4c, 0x3c, 0x0d, 0xef, 0xbd, 0xf0, 0x40, 0x03,
0xf8, 0xf8, 0x90, 0x90, 0x00, 0x02, 0x10, 0x77,
0x00, 0x2c, 0x40, 0x40, 0x3b, 0x10, 0xfc, 0xd2,
0xf0, 0x80,
/* Analog */
0xd9, 0x16, 0x40, 0x40, 0x80, 0x40, 0x80, 0x4f,
0xfe, 0x01, 0xcf, 0x0f, 0x03, 0x01, 0x81, 0x0a,
0x40, 0x35, 0x02, 0x8c, 0x03
};
static void
addrI2CB(int addr, int val)
{
ulong s;
s = splhi();
startI2C();
wrI2CD(SAA7110|WRITE_C);
wrI2CD(addr);
wrI2CD(val);
endI2C();
splx(s);
}
static void
inittrident(void)
{
int i;
for(i = 0; trireg[i].reg != -1; i++)
triwr(trireg[i].reg, trireg[i].val);
for(i = 0; i < 47; i++)
addrI2CB(i, setupSAA7110[i]);
}
static void
initcrystal(void)
{
int i;
static int done;
if(done)
return;
done = 1;
initctl();
/* Reboot the Musicam decoder */
clrI2C(SCL);
clrI2C(SDA);
machsr |= DSPRST;
outs(mpegconf.zrport+ZRMACH210, machsr);
machsr |= DSPBOOT;
outs(mpegconf.zrport+ZRMACH210, machsr);
machsr &= ~DSPRST;
outs(mpegconf.zrport+ZRMACH210, machsr);
machsr |= DSPRST;
outs(mpegconf.zrport+ZRMACH210, machsr);
machsr &= ~DSPBOOT;
outs(mpegconf.zrport+ZRMACH210, machsr);
startI2C();
wrI2CD(0);
for(i = 0; i < sizeof(crystal); i++ )
wrI2CD(crystal[i]);
endI2C();
}
static void
mpegintr(Ureg*, void*)
{
Buf *b;
b = bqueue.head;
if(b == 0 || dmadone(mpegconf.dma) == 0)
return;
dmaend(mpegconf.dma);
if(b->nchar == 0) {
bqueue.head = b->link;
free(b);
b = bqueue.head;
if(b == 0) {
started = 0;
return;
}
}
zrdma(b);
wakeup(&bqueue.flow);
}