ref: 59ed389a6eb7d405eb44d9644d69993e814dccdf
dir: /sys/src/9/pc/devtv.c/
/*
* Driver for Bt848 TV tuner.
*
*/
#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
#include "../port/error.h"
#include "io.h"
#include "hcwAMC.h"
#define max(a, b) (((a) > (b))? (a): (b))
enum {
Qdir = 0,
Qsubdir,
Qsubbase,
Qvdata = Qsubbase,
Qadata,
Qctl,
Qregs,
Brooktree_vid = 0x109e,
Brooktree_848_did = 0x0350,
Brooktree_878_did = 0x036E,
Intel_vid = 0x8086,
Intel_82437_did = 0x122d,
K = 1024,
M = K * K,
Ntvs = 4,
Numring = 16,
ntsc_rawpixels = 910,
ntsc_sqpixels = 780, /* Including blanking & inactive */
ntsc_hactive = 640,
ntsc_vactive = 480,
ntsc_clkx1delay = 135, /* Clock ticks. */
ntsc_clkx1hactive = 754,
ntsc_vdelay = 26, /* # of scan lines. */
ntsc_vscale = 0,
i2c_nostop = 1 << 5,
i2c_nos1b = 1 << 4,
i2c_timing = 7 << 4,
i2c_bt848w3b = 1 << 2,
i2c_bt848scl = 1 << 1,
i2c_bt848sda = 1 << 0,
i2c_scl = i2c_bt848scl,
i2c_sda = i2c_bt848sda,
i2c_miroproee = 0x80, /* MIRO PRO EEPROM */
i2c_tea6300 = 0x80,
i2c_tda8425 = 0x82,
i2c_tda9840 = 0x84,
i2c_tda9850 = 0xb6,
i2c_haupee = 0xa0, /* Hauppage EEPROM */
i2c_stbee = 0xae, /* STB EEPROM */
i2c_msp3400 = 0x80,
i2c_timeout = 1000,
i2c_delay = 10,
Bt848_miropro = 0,
Bt848_miro,
Bt878_hauppauge,
/* Bit fields. */
iform_muxsel1 = 3 << 5, /* 004 */
iform_muxsel0 = 2 << 5,
iform_xtselmask = 3 << 3,
iform_xtauto = 3 << 3,
iform_formatmask = 7 << 0,
iform_ntsc = 1 << 0,
control_ldec = 1 << 5, /* 02C */
contrast_100percent = 0xd8, /* 030 */
vscale_interlaced = 1 << 5, /* 04C */
adelay_ntsc = 104, /* 060 */
bdelay_ntsc = 93, /* 064 */
adc_crush = 1 << 0, /* 068 */
colorfmt_rgb16 = 2 << 4 | 2 << 0, /* 0D4 */
colorfmt_YCbCr422 = 8 << 4 | 8 << 0,
colorfmt_YCbCr411 = 9 << 4 | 9 << 0,
colorctl_gamma = 1 << 4, /* 0D8 */
capctl_fullframe = 1 << 4, /* 0DC */
capctl_captureodd = 1 << 1,
capctl_captureeven = 1 << 0,
vbipacksize = 0x190, /* 0E0 */
intstat_riscstatshift = 28, /* 100 */
intstat_i2crack = 1 << 25,
intstat_scerr = 1 << 19,
intstat_ocerr = 1 << 18,
intstat_pabort = 1 << 17,
intstat_riperr = 1 << 16,
intstat_pperr = 1 << 15,
intstat_fdsr = 1 << 14,
intstat_ftrgt = 1 << 13,
intstat_fbus = 1 << 12,
intstat_risci = 1 << 11,
intstat_i2cdone = 1 << 8,
intstat_vpress = 1 << 5,
intstat_hlock = 1 << 4,
intstat_vsync = 1 << 1,
intstat_fmtchg = 1 << 0,
intmask_etbf = 1 << 23, /* 104 */
gpiodmactl_apwrdn = 1 << 26, /* 10C */
gpiodmactl_daes2 = 1 << 13,
gpiodmactl_daiomda = 1 << 6,
gpiodmactl_pltp23_16 = 2 << 6,
gpiodmactl_pltp23_0 = 0 << 6,
gpiodmactl_pltp1_16 = 2 << 4,
gpiodmactl_pltp1_0 = 0 << 4,
gpiodmactl_acapenable = 1 << 4,
gpiodmactl_pktp_32 = 3 << 2,
gpiodmactl_pktp_0 = 0 << 2,
gpiodmactl_riscenable = 1 << 1,
gpiodmactl_fifoenable = 1 << 0,
/* RISC instructions and parameters. */
fifo_vre = 0x4,
fifo_vro = 0xc,
fifo_fm1 = 0x6,
fifo_fm3 = 0xe,
riscirq = 1 << 24,
riscwrite = 1 << 28,
riscwrite123 = 9 << 28,
riscwrite1s23 = 11 << 28,
riscwrite_sol = 1 << 27,
riscwrite_eol = 1 << 26,
riscskip = 0x2 << 28,
riscjmp = 0x7 << 28,
riscsync = 0x8 << 28,
riscsync_resync = 1 << 15,
riscsync_vre = fifo_vre << 0,
riscsync_vro = fifo_vro << 0,
riscsync_fm1 = fifo_fm1 << 0,
riscsync_fm3 = fifo_fm3 << 0,
risclabelshift_set = 16,
risclabelshift_reset = 20,
AudioTuner = 0,
AudioRadio,
AudioExtern,
AudioIntern,
AudioOff,
AudioOn,
asel_tv = 0,
asel_radio,
asel_mic,
asel_smxc,
Hwbase_ad = 448000,
msp_dem = 0x10,
msp_bbp = 0x12,
/* Altera definitions. */
gpio_altera_data = 1 << 0,
gpio_altera_clock = 1 << 20,
gpio_altera_nconfig = 1 << 23,
Ial = 0x140001,
Idma = 0x100002,
Adsp = 0x7fd8,
Adsp_verifysystem = 1,
Adsp_querysupportplay,
Adsp_setstyle,
Adsp_setsrate,
Adsp_setchannels,
Adsp_setresolution,
Adsp_setcrcoptions,
Adsp_bufenqfor,
Adsp_logbuffer,
Adsp_startplay,
Adsp_stopplay,
Adsp_autostop,
Adsp_startrecord,
Adsp_stoprecord,
Adsp_getlastprocessed,
Adsp_pause,
Adsp_resume,
Adsp_setvolume,
Adsp_querysupportrecord,
Adsp_generalbufenq,
Adsp_setdownmixtype,
Adsp_setigain,
Adsp_setlineout,
Adsp_setlangmixtype,
Kfir_gc = 0,
Kfir_dsp_riscmc,
Kfir_dsp_risccram,
Kfir_dsp_unitmc,
Kfir_bsm_mc,
Kfir_mux_mc,
Kfir_devid_gc = 7,
Kfir_devid_dsp = 4,
Kfir_devid_bsm = 5,
Kfir_devid_mux = 8,
Kfir_200 = 200,
Kfir_dev_inst = Kfir_200,
Kfir_201 = 201,
Kfir_exec = Kfir_201,
Kfir_202 = 202,
Kfir_adr_eready = 254,
Kfir_d_eready_encoding = 0,
Kfir_d_eready_ready,
Kfir_d_eready_test,
Kfir_d_eready_stopdetect,
Kfir_d_eready_seqend,
VT_KFIR_OFF = 0,
VT_KFIR_ON,
VT_KFIR_LAYER_II = 1,
VT_KFIR_STEREO = 1,
Gpioinit = 0,
Gpiooutput,
Gpioinput,
Srate_5512 = 0,
Srate_11025 = 2,
Srate_16000 = 3,
Srate_22050 = 4,
Srate_32000 = 5,
Srate_44100 = 6,
Srate_48000 = 7,
};
typedef struct Variant Variant;
struct Variant {
ushort vid;
ushort did;
char *name;
};
typedef struct Bt848 Bt848;
struct Bt848 {
ulong devstat; /* 000 */
ulong iform; /* 004 */
ulong tdec; /* 008 */
ulong ecrop; /* 00C */
ulong evdelaylo; /* 010 */
ulong evactivelo; /* 014 */
ulong ehdelaylo; /* 018 */
ulong ehactivelo; /* 01C */
ulong ehscalehi; /* 020 */
ulong ehscalelo; /* 024 */
ulong bright; /* 028 */
ulong econtrol; /* 02C */
ulong contrastlo; /* 030 */
ulong satulo; /* 034 */
ulong satvlo; /* 038 */
ulong hue; /* 03C */
ulong escloop; /* 040 */
ulong pad0; /* 044 */
ulong oform; /* 048 */
ulong evscalehi; /* 04C */
ulong evscalelo; /* 050 */
ulong test; /* 054 */
ulong pad1[2]; /* 058-05C */
ulong adelay; /* 060 */
ulong bdelay; /* 064 */
ulong adc; /* 068 */
ulong evtc; /* 06C */
ulong pad2[3]; /* 070-078 */
ulong sreset; /* 07C */
ulong tglb; /* 080 */
ulong tgctrl; /* 084 */
ulong pad3; /* 088 */
ulong ocrop; /* 08C */
ulong ovdelaylo; /* 090 */
ulong ovactivelo; /* 094 */
ulong ohdelaylo; /* 098 */
ulong ohactivelo; /* 09C */
ulong ohscalehi; /* 0A0 */
ulong ohscalelo; /* 0A4 */
ulong pad4; /* 0A8 */
ulong ocontrol; /* 0AC */
ulong pad5[4]; /* 0B0-0BC */
ulong oscloop; /* 0C0 */
ulong pad6[2]; /* 0C4-0C8 */
ulong ovscalehi; /* 0CC */
ulong ovscalelo; /* 0D0 */
ulong colorfmt; /* 0D4 */
ulong colorctl; /* 0D8 */
ulong capctl; /* 0DC */
ulong vbipacksize; /* 0E0 */
ulong vbipackdel; /* 0E4 */
ulong fcap; /* 0E8 */
ulong ovtc; /* 0EC */
ulong pllflo; /* 0F0 */
ulong pllfhi; /* 0F4 */
ulong pllxci; /* 0F8 */
ulong dvsif; /* 0FC */
ulong intstat; /* 100 */
ulong intmask; /* 104 */
ulong pad7; /* 108 */
ulong gpiodmactl; /* 10C */
ulong i2c; /* 110 */
ulong riscstrtadd; /* 114 */
ulong gpioouten; /* 118 */
ulong gpioreginp; /* 11C */
ulong risccount; /* 120 */
ulong pad8[55]; /* 124-1FC */
ulong gpiodata[64]; /* 200-2FC */
};
#define packetlen i2c
typedef struct Tuner Tuner;
struct Tuner {
char *name;
ushort freq_vhfh; /* Start frequency */
ushort freq_uhf;
uchar VHF_L;
uchar VHF_H;
uchar UHF;
uchar cfg;
ushort offs;
};
typedef struct Frame Frame;
struct Frame {
ulong *fstart;
ulong *fjmp;
uchar *fbase;
};
typedef struct Tv Tv;
struct Tv {
Lock;
Rendez;
Bt848 *bt848;
Bt848 *bt878; /* Really only audio control registers */
Variant *variant;
Tuner *tuner;
Pcidev *pci;
uchar i2ctuneraddr;
uchar i2ccmd; /* I2C command */
int board; /* What board is this? */
ulong cfmt; /* Current color format. */
int channel; /* Current channel */
Ref fref; /* Copying images? */
int nframes; /* Number of frames to capture. */
Frame *frames; /* DMA program */
int lvframe; /* Last video frame DMAed */
uchar *amux; /* Audio multiplexer. */
int nablocks; /* Number of audio blocks allocated */
int absize; /* Audio block size */
int narblocks; /* Number of audio blocks received */
ulong *arisc; /* Audio risc bloc */
uchar *abuf; /* Audio data buffers */
char ainfo[128];
/* WinTV/PVR stuff. */
int msp;
Lock kfirlock;
ulong i2cstate; /* Last i2c state. */
int gpiostate; /* Current GPIO state */
ulong alterareg; /* Last used altera register */
ulong alteraclock; /* Used to clock the altera */
int asrate; /* Audio sample rate */
uchar aleft, aright; /* Left and right audio volume */
ulong kfirclock;
Ref aref; /* Copying audio? */
};
enum {
TemicPAL = 0,
PhilipsPAL,
PhilipsNTSC,
PhilipsSECAM,
Notuner,
PhilipsPALI,
TemicNTSC,
TemicPALI,
Temic4036,
AlpsTSBH1,
AlpsTSBE1,
Freqmultiplier = 16,
};
static Tuner tuners[] = {
{"Temic PAL", Freqmultiplier * 140.25, Freqmultiplier * 463.25,
0x02, 0x04, 0x01, 0x8e, 623 },
{"Philips PAL_I", Freqmultiplier * 140.25, Freqmultiplier * 463.25,
0xa0, 0x90, 0x30, 0x8e, 623 },
{"Philips NTSC", Freqmultiplier * 157.25, Freqmultiplier * 451.25,
0xA0, 0x90, 0x30, 0x8e, 732 },
{"Philips SECAM", Freqmultiplier * 168.25, Freqmultiplier * 447.25,
0xA7, 0x97, 0x37, 0x8e, 623 },
{"NoTuner", 0, 0,
0x00, 0x00, 0x00, 0x00, 0 },
{"Philips PAL", Freqmultiplier * 168.25, Freqmultiplier * 447.25,
0xA0, 0x90, 0x30, 0x8e, 623 },
{"Temic NTSC", Freqmultiplier * 157.25, Freqmultiplier * 463.25,
0x02, 0x04, 0x01, 0x8e, 732 },
{"TEMIC PAL_I", Freqmultiplier * 170.00, Freqmultiplier * 450.00,
0x02, 0x04, 0x01, 0x8e, 623 },
{"Temic 4036 FY5 NTSC", Freqmultiplier * 157.25, Freqmultiplier * 463.25,
0xa0, 0x90, 0x30, 0x8e, 732 },
{"Alps TSBH1", Freqmultiplier * 137.25, Freqmultiplier * 385.25,
0x01, 0x02, 0x08, 0x8e, 732 },
{"Alps TSBE1", Freqmultiplier * 137.25, Freqmultiplier * 385.25,
0x01, 0x02, 0x08, 0x8e, 732 },
};
static int hp_tuners[] = {
Notuner,
Notuner,
Notuner,
Notuner,
Notuner,
PhilipsNTSC,
Notuner,
Notuner,
PhilipsPAL,
PhilipsSECAM,
PhilipsNTSC,
PhilipsPALI,
Notuner,
Notuner,
TemicPAL,
TemicPALI,
Notuner,
PhilipsSECAM,
PhilipsNTSC,
PhilipsPALI,
Notuner,
PhilipsPAL,
Notuner,
PhilipsNTSC,
};
enum {
CMvstart,
CMastart,
CMastop,
CMvgastart,
CMvstop,
CMchannel,
CMcolormode,
CMvolume,
CMmute,
};
static Cmdtab tvctlmsg[] = {
CMvstart, "vstart", 2,
CMastart, "astart", 5,
CMastop, "astop", 1,
CMvgastart, "vgastart", 3,
CMvstop, "vstop", 1,
CMchannel, "channel", 3,
CMcolormode, "colormode", 2,
CMvolume, "volume", 3,
CMmute, "mute", 1,
};
static Variant variant[] = {
{ Brooktree_vid, Brooktree_848_did, "Brooktree 848 TV tuner", },
{ Brooktree_vid, Brooktree_878_did, "Brooktree 878 TV tuner", },
};
static char *boards[] = {
"MIRO PRO",
"MIRO",
"Hauppauge Bt878",
};
static ushort Adspfsample[] = {
0x500, 0x700, 0x400, 0x600, 0x300, 0x200, 0x000, 0x100
};
static ushort Adspstereorates[] = {
64, 96, 112, 128, 160, 192, 224, 256, 320, 384
};
static uchar miroamux[] = { 2, 0, 0, 0, 10, 0 };
static uchar hauppaugeamux[] = { 0, 1, 2, 3, 4, 0 };
static char *nicamstate[] = {
"analog", "???", "digital", "bad digital receiption"
};
static Tv tvs[Ntvs];
static int ntvs;
static int i2cread(Tv *, uchar, uchar *);
static int i2cwrite(Tv *, uchar, uchar, uchar, int);
static void tvinterrupt(Ureg *, Tv *);
static void vgastart(Tv *, ulong, int);
static void vstart(Tv *, int, int, int, int);
static void astart(Tv *, char *, uint, uint, uint);
static void vstop(Tv *);
static void astop(Tv *);
static void colormode(Tv *, char *);
static void frequency(Tv *, int, int);
static int getbitspp(Tv *);
static char *getcolormode(ulong);
static int mspreset(Tv *);
static void i2cscan(Tv *);
static int kfirinitialize(Tv *);
static void msptune(Tv *);
static void mspvolume(Tv *, int, int, int);
static void gpioenable(Tv *, ulong, ulong);
static void gpiowrite(Tv *, ulong, ulong);
static void
tvinit(void)
{
Pcidev *pci;
ulong intmask;
/* Test for a triton memory controller. */
intmask = 0;
if (pcimatch(nil, Intel_vid, Intel_82437_did))
intmask = intmask_etbf;
pci = nil;
while ((pci = pcimatch(pci, 0, 0)) != nil) {
int i, t;
Tv *tv;
Bt848 *bt848;
ushort hscale, hdelay;
uchar v;
for (i = 0; i != nelem(variant); i++)
if (pci->vid == variant[i].vid && pci->did == variant[i].did)
break;
if (i == nelem(variant))
continue;
if (ntvs >= Ntvs) {
print("#V: Too many TV cards found\n");
continue;
}
tv = &tvs[ntvs++];
tv->variant = &variant[i];
tv->pci = pci;
tv->bt848 = (Bt848 *)vmap(pci->mem[0].bar & ~0x0F, 4 * K);
if (tv->bt848 == nil)
panic("#V: Cannot allocate memory for Bt848");
bt848 = tv->bt848;
/* i2c stuff. */
if (pci->did >= 878)
tv->i2ccmd = 0x83;
else
tv->i2ccmd = i2c_timing | i2c_bt848scl | i2c_bt848sda;
t = 0;
if (i2cread(tv, i2c_haupee, &v)) {
uchar ee[256];
Pcidev *pci878;
Bt848 *bt878;
tv->board = Bt878_hauppauge;
if (!i2cwrite(tv, i2c_haupee, 0, 0, 0))
panic("#V: Cannot write to Hauppauge EEPROM");
for (i = 0; i != sizeof ee; i++)
if (!i2cread(tv, i2c_haupee + 1, &ee[i]))
panic("#V: Cannot read from Hauppauge EEPROM");
if (ee[9] > sizeof hp_tuners / sizeof hp_tuners[0])
panic("#V: Tuner out of range (max %d, this %d)",
sizeof hp_tuners / sizeof hp_tuners[0], ee[9]);
t = hp_tuners[ee[9]];
/* Initialize the audio channel. */
if ((pci878 = pcimatch(nil, Brooktree_vid, 0x878)) == nil)
panic("#V: Unsupported Hauppage board");
tv->bt878 = bt878 =
(Bt848 *)vmap(pci878->mem[0].bar & ~0x0F, 4 * K);
if (bt878 == nil)
panic("#V: Cannot allocate memory for the Bt878");
kfirinitialize(tv);
// i2cscan(tv);
mspreset(tv);
bt878->gpiodmactl = 0;
bt878->intstat = (ulong)-1;
intrenable(pci878->intl, (void (*)(Ureg *, void *))tvinterrupt,
tv, pci878->tbdf, "tv");
tv->amux = hauppaugeamux;
}
else if (i2cread(tv, i2c_stbee, &v)) {
USED(t);
panic("#V: Cannot deal with STB cards");
}
else if (i2cread(tv, i2c_miroproee, &v)) {
tv->board = Bt848_miropro;
t = ((bt848->gpiodata[0] >> 10) - 1) & 7;
tv->amux = miroamux;
}
else {
tv->board = Bt848_miro;
tv->amux = miroamux;
t = ((bt848->gpiodata[0] >> 10) - 1) & 7;
}
if (t >= nelem(tuners))
t = 4;
tv->tuner = &tuners[t];
tv->i2ctuneraddr =
i2cread(tv, 0xc1, &v)? 0xc0:
i2cread(tv, 0xc3, &v)? 0xc2:
i2cread(tv, 0xc5, &v)? 0xc4:
i2cread(tv, 0xc7, &v)? 0xc6: -1;
bt848->capctl = capctl_fullframe;
bt848->adelay = adelay_ntsc;
bt848->bdelay = bdelay_ntsc;
bt848->iform = iform_muxsel0|iform_xtauto|iform_ntsc;
bt848->vbipacksize = vbipacksize & 0xff;
bt848->vbipackdel = (vbipacksize >> 8) & 1;
// setpll(bt848);
tv->cfmt = bt848->colorfmt = colorfmt_rgb16;
hscale = (ntsc_rawpixels * 4096) / ntsc_sqpixels - 4096;
hdelay = (ntsc_clkx1delay * ntsc_hactive) / ntsc_clkx1hactive;
bt848->ovtc = bt848->evtc = 0;
bt848->ehscalehi = bt848->ohscalehi = (hscale >> 8) & 0xff;
bt848->ehscalelo = bt848->ohscalelo = hscale & 0xff;
bt848->evscalehi &= ~0x1f;
bt848->ovscalehi &= ~0x1f;
bt848->evscalehi |= vscale_interlaced | ((ntsc_vscale >> 8) & 0x1f);
bt848->ovscalehi |= vscale_interlaced | (ntsc_vscale >> 8) & 0x1f;
bt848->evscalelo = bt848->ovscalelo = ntsc_vscale & 0xff;
bt848->ehactivelo = bt848->ohactivelo = ntsc_hactive & 0xff;
bt848->ehdelaylo = bt848->ohdelaylo = hdelay & 0xff;
bt848->evactivelo = bt848->ovactivelo = ntsc_vactive & 0xff;
bt848->evdelaylo = bt848->ovdelaylo = ntsc_vdelay & 0xff;
bt848->ecrop = bt848->ocrop =
((ntsc_hactive >> 8) & 0x03) |
((hdelay >> 6) & 0x0C) |
((ntsc_vactive >> 4) & 0x30) |
((ntsc_vdelay >> 2) & 0xC0);
bt848->colorctl = colorctl_gamma;
bt848->capctl = 0;
bt848->gpiodmactl = gpiodmactl_pltp23_16 |
gpiodmactl_pltp1_16 | gpiodmactl_pktp_32;
bt848->gpioreginp = 0;
bt848->contrastlo = contrast_100percent;
bt848->bright = 16;
bt848->adc = (2 << 6) | adc_crush;
bt848->econtrol = bt848->ocontrol = control_ldec;
bt848->escloop = bt848->oscloop = 0;
bt848->intstat = (ulong)-1;
bt848->intmask = intmask |
intstat_vsync | intstat_scerr | intstat_risci | intstat_ocerr |
intstat_vpress | intstat_fmtchg;
if (tv->amux) {
gpioenable(tv, ~0xfff, 0xfff);
gpiowrite(tv, ~0xfff, tv->amux[AudioRadio]);
}
print("#V%ld: %s (rev %d) (%s/%s) intl %d\n",
tv - tvs, tv->variant->name, pci->rid, boards[tv->board],
tv->tuner->name, pci->intl);
intrenable(pci->intl, (void (*)(Ureg *, void *))tvinterrupt,
tv, pci->tbdf, "tv");
}
}
static Chan*
tvattach(char *spec)
{
return devattach('V', spec);
}
#define TYPE(q) ((int)((q).path & 0xff))
#define DEV(q) ((int)(((q).path >> 8) & 0xff))
#define QID(d, t) ((((d) & 0xff) << 8) | (t))
static int
tv1gen(Chan *c, int i, Dir *dp)
{
Qid qid;
switch (i) {
case Qvdata:
mkqid(&qid, QID(DEV(c->qid), Qvdata), 0, QTFILE);
devdir(c, qid, "video", 0, eve, 0444, dp);
return 1;
case Qadata:
mkqid(&qid, QID(DEV(c->qid), Qadata), 0, QTFILE);
devdir(c, qid, "audio", 0, eve, 0444, dp);
return 1;
case Qctl:
mkqid(&qid, QID(DEV(c->qid), Qctl), 0, QTFILE);
devdir(c, qid, "ctl", 0, eve, 0444, dp);
return 1;
case Qregs:
mkqid(&qid, QID(DEV(c->qid), Qregs), 0, QTFILE);
devdir(c, qid, "regs", 0, eve, 0444, dp);
return 1;
}
return -1;
}
static int
tvgen(Chan *c, char *, Dirtab *, int, int i, Dir *dp)
{
Qid qid;
int dev;
dev = DEV(c->qid);
switch (TYPE(c->qid)) {
case Qdir:
if (i == DEVDOTDOT) {
mkqid(&qid, Qdir, 0, QTDIR);
devdir(c, qid, "#V", 0, eve, 0555, dp);
return 1;
}
if (i >= ntvs)
return -1;
mkqid(&qid, QID(i, Qsubdir), 0, QTDIR);
snprint(up->genbuf, sizeof(up->genbuf), "tv%d", i);
devdir(c, qid, up->genbuf, 0, eve, 0555, dp);
return 1;
case Qsubdir:
if (i == DEVDOTDOT) {
mkqid(&qid, QID(dev, Qdir), 0, QTDIR);
snprint(up->genbuf, sizeof(up->genbuf), "tv%d", dev);
devdir(c, qid, up->genbuf, 0, eve, 0555, dp);
return 1;
}
return tv1gen(c, i + Qsubbase, dp);
case Qvdata:
case Qadata:
case Qctl:
case Qregs:
return tv1gen(c, TYPE(c->qid), dp);
default:
return -1;
}
}
static Walkqid *
tvwalk(Chan *c, Chan *nc, char **name, int nname)
{
return devwalk(c, nc, name, nname, 0, 0, tvgen);
}
static int
tvstat(Chan *c, uchar *db, int n)
{
return devstat(c, db, n, 0, 0, tvgen);
}
static Chan*
tvopen(Chan *c, int omode)
{
if (omode != OREAD &&
TYPE(c->qid) != Qctl && TYPE(c->qid) != Qvdata)
error(Eperm);
switch (TYPE(c->qid)) {
case Qdir:
return devopen(c, omode, nil, 0, tvgen);
case Qadata:
if (tvs[DEV(c->qid)].bt878 == nil)
error(Enonexist);
break;
}
c->mode = openmode(omode);
c->flag |= COPEN;
c->offset = 0;
if (TYPE(c->qid) == Qadata)
c->aux = nil;
return c;
}
static void
tvclose(Chan *)
{
}
static int
audioblock(void *)
{
return 1;
}
static long
tvread(Chan *c, void *a, long n, vlong offset)
{
static char regs[10 * K];
static int regslen;
Tv *tv;
char *e, *p;
uchar *src;
USED(offset);
switch(TYPE(c->qid)) {
case Qdir:
case Qsubdir:
return devdirread(c, a, n, 0, 0, tvgen);
case Qvdata: {
int bpf, nb;
tv = &tvs[DEV(c->qid)];
bpf = ntsc_hactive * ntsc_vactive * getbitspp(tv) / 8;
if (offset >= bpf)
return 0;
nb = n;
if (offset + nb > bpf)
nb = bpf - offset;
ilock(tv);
if (tv->frames == nil || tv->lvframe >= tv->nframes ||
tv->frames[tv->lvframe].fbase == nil) {
iunlock(tv);
return 0;
}
src = tv->frames[tv->lvframe].fbase;
incref(&tv->fref);
iunlock(tv);
memmove(a, src + offset, nb);
decref(&tv->fref);
return nb;
}
case Qadata: {
ulong uablock = (ulong)c->aux, bnum, tvablock;
int boffs, nbytes;
tv = &tvs[DEV(c->qid)];
if (tv->bt878 == nil)
error("#V: No audio device");
if (tv->absize == 0)
error("#V: audio not initialized");
bnum = offset / tv->absize;
boffs = offset % tv->absize;
nbytes = tv->absize - boffs;
incref(&tv->aref);
for (;;) {
tvablock = tv->narblocks; /* Current tv block. */
if (uablock == 0)
uablock = tvablock - 1;
if (tvablock >= uablock + bnum + tv->narblocks)
uablock = tvablock - 1 - bnum;
if (uablock + bnum == tvablock) {
sleep(tv, audioblock, nil);
continue;
}
break;
}
print("uablock %ld, bnum %ld, boffs %d, nbytes %d, tvablock %ld\n",
uablock, bnum, boffs, nbytes, tvablock);
src = tv->abuf + ((uablock + bnum) % tv->nablocks) * tv->absize;
print("copying from %#p (abuf %#p), nbytes %d (block %ld.%ld)\n",
src + boffs, tv->abuf, nbytes, uablock, bnum);
memmove(a, src + boffs, nbytes);
decref(&tv->aref);
uablock += (boffs + nbytes) % tv->absize;
c->aux = (void*)uablock;
return nbytes;
}
case Qctl: {
char str[128];
tv = &tvs[DEV(c->qid)];
snprint(str, sizeof str, "%dx%dx%d %s channel %d %s\n",
ntsc_hactive, ntsc_vactive, getbitspp(tv),
getcolormode(tv->cfmt), tv->channel, tv->ainfo);
return readstr(offset, a, strlen(str) + 1, str);
}
case Qregs:
if (offset == 0) {
Bt848 *bt848;
int i;
tv = &tvs[DEV(c->qid)];
bt848 = tv->bt848;
e = regs + sizeof(regs);
p = regs;
for (i = 0; i < 0x300 >> 2; i++)
p = seprint(p, e, "%.3X %.8ulX\n", i << 2,
((ulong *)bt848)[i]);
if (tv->bt878) {
bt848 = tv->bt878;
for (i = 0; i < 0x300 >> 2; i++)
p = seprint(p, e, "%.3X %.8ulX\n",
i << 2, ((ulong *)bt848)[i]);
}
regslen = p - regs;
}
if (offset >= regslen)
return 0;
if (offset + n > regslen)
n = regslen - offset;
return readstr(offset, a, n, ®s[offset]);
default:
n = 0;
break;
}
return n;
}
static long
tvwrite(Chan *c, void *a, long n, vlong)
{
Cmdbuf *cb;
Cmdtab *ct;
Tv *tv;
tv = &tvs[DEV(c->qid)];
switch(TYPE(c->qid)) {
case Qctl:
cb = parsecmd(a, n);
if(waserror()){
free(cb);
nexterror();
}
ct = lookupcmd(cb, tvctlmsg, nelem(tvctlmsg));
switch (ct->index) {
case CMvstart:
vstart(tv, (int)strtol(cb->f[1], (char **)nil, 0),
ntsc_hactive, ntsc_vactive, ntsc_hactive);
break;
case CMastart:
astart(tv, cb->f[1], (uint)strtol(cb->f[2], (char **)nil, 0),
(uint)strtol(cb->f[3], (char **)nil, 0),
(uint)strtol(cb->f[4], (char **)nil, 0));
break;
case CMastop:
astop(tv);
break;
case CMvgastart:
vgastart(tv, strtoul(cb->f[1], (char **)nil, 0),
(int)strtoul(cb->f[2], (char **)nil, 0));
break;
case CMvstop:
vstop(tv);
break;
case CMchannel:
frequency(tv, (int)strtol(cb->f[1], (char **)nil, 0),
(int)strtol(cb->f[2], (char **)nil, 0));
break;
case CMcolormode:
colormode(tv, cb->f[1]);
break;
case CMvolume:
if (!tv->msp)
error("#V: No volume control");
mspvolume(tv, 0, (int)strtol(cb->f[1], (char **)nil, 0),
(int)strtol(cb->f[2], (char **)nil, 0));
break;
case CMmute:
if (!tv->msp)
error("#V: No volume control");
mspvolume(tv, 1, 0, 0);
break;
}
poperror();
free(cb);
break;
default:
error(Eio);
}
return n;
}
Dev tvdevtab = {
'V',
"tv",
devreset,
tvinit,
devshutdown,
tvattach,
tvwalk,
tvstat,
tvopen,
devcreate,
tvclose,
tvread,
devbread,
tvwrite,
devbwrite,
devremove,
devwstat,
};
static void
tvinterrupt(Ureg *, Tv *tv)
{
Bt848 *bt848 = tv->bt848, *bt878 = tv->bt878;
for (;;) {
ulong vstat, astat;
uchar fnum;
vstat = bt848->intstat;
fnum = (vstat >> intstat_riscstatshift) & 0xf;
vstat &= bt848->intmask;
if (bt878)
astat = bt878->intstat & bt878->intmask;
else
astat = 0;
if (vstat == 0 && astat == 0)
break;
if (astat)
print("vstat %.8luX, astat %.8luX\n", vstat, astat);
bt848->intstat = vstat;
if (bt878)
bt878->intstat = astat;
if ((vstat & intstat_fmtchg) == intstat_fmtchg) {
iprint("int: fmtchg\n");
vstat &= ~intstat_fmtchg;
}
if ((vstat & intstat_vpress) == intstat_vpress) {
// iprint("int: vpress\n");
vstat &= ~intstat_vpress;
}
if ((vstat & intstat_vsync) == intstat_vsync)
vstat &= ~intstat_vsync;
if ((vstat & intstat_scerr) == intstat_scerr) {
iprint("int: scerr\n");
bt848->gpiodmactl &=
~(gpiodmactl_riscenable|gpiodmactl_fifoenable);
bt848->gpiodmactl |= gpiodmactl_fifoenable;
bt848->gpiodmactl |= gpiodmactl_riscenable;
vstat &= ~intstat_scerr;
}
if ((vstat & intstat_risci) == intstat_risci) {
tv->lvframe = fnum;
vstat &= ~intstat_risci;
}
if ((vstat & intstat_ocerr) == intstat_ocerr) {
iprint("int: ocerr\n");
vstat &= ~intstat_ocerr;
}
if ((vstat & intstat_fbus) == intstat_fbus) {
iprint("int: fbus\n");
vstat &= ~intstat_fbus;
}
if (vstat)
iprint("int: (v) ignored interrupts %.8ulX\n", vstat);
if ((astat & intstat_risci) == intstat_risci) {
tv->narblocks++;
if ((tv->narblocks % 100) == 0)
print("a");
wakeup(tv);
astat &= ~intstat_risci;
}
if ((astat & intstat_fdsr) == intstat_fdsr) {
iprint("int: (a) fdsr\n");
bt848->gpiodmactl &=
~(gpiodmactl_acapenable |
gpiodmactl_riscenable | gpiodmactl_fifoenable);
astat &= ~intstat_fdsr;
}
if (astat)
iprint("int: (a) ignored interrupts %.8ulX\n", astat);
}
}
static int
i2cread(Tv *tv, uchar off, uchar *v)
{
Bt848 *bt848 = tv->bt848;
ulong intstat;
int i;
bt848->intstat = intstat_i2cdone;
bt848->i2c = (off << 24) | tv->i2ccmd;
intstat = -1;
for (i = 0; i != 1000; i++) {
if ((intstat = bt848->intstat) & intstat_i2cdone)
break;
microdelay(1000);
}
if (i == 1000) {
print("i2cread: timeout\n");
return 0;
}
if ((intstat & intstat_i2crack) == 0)
return 0;
*v = bt848->i2c >> 8;
return 1;
}
static int
i2cwrite(Tv *tv, uchar addr, uchar sub, uchar data, int both)
{
Bt848 *bt848 = tv->bt848;
ulong intstat, d;
int i;
bt848->intstat = intstat_i2cdone;
d = (addr << 24) | (sub << 16) | tv->i2ccmd;
if (both)
d |= (data << 8) | i2c_bt848w3b;
bt848->i2c = d;
intstat = 0;
for (i = 0; i != 1000; i++) {
if ((intstat = bt848->intstat) & intstat_i2cdone)
break;
microdelay(1000);
}
if (i == i2c_timeout) {
print("i2cwrite: timeout\n");
return 0;
}
if ((intstat & intstat_i2crack) == 0)
return 0;
return 1;
}
static ulong *
riscpacked(ulong pa, int fnum, int w, int h, int stride, ulong **lastjmp)
{
ulong *p, *pbase;
int i;
pbase = p = (ulong *)malloc((h + 6) * 2 * sizeof(ulong));
assert(p);
assert(w <= 0x7FF);
*p++ = riscsync | riscsync_resync | riscsync_vre;
*p++ = 0;
*p++ = riscsync | riscsync_fm1;
*p++ = 0;
for (i = 0; i != h / 2; i++) {
*p++ = riscwrite | w | riscwrite_sol | riscwrite_eol;
*p++ = pa + i * 2 * stride;
}
*p++ = riscsync | riscsync_resync | riscsync_vro;
*p++ = 0;
*p++ = riscsync | riscsync_fm1;
*p++ = 0;
for (i = 0; i != h / 2; i++) {
*p++ = riscwrite | w | riscwrite_sol | riscwrite_eol;
*p++ = pa + (i * 2 + 1) * stride;
}
/* reset status. you really need two instructions ;-(. */
*p++ = riscjmp | (0xf << risclabelshift_reset);
*p++ = PADDR(p);
*p++ = riscjmp | riscirq | (fnum << risclabelshift_set);
*lastjmp = p;
return pbase;
}
static ulong *
riscplanar411(ulong pa, int fnum, int w, int h, ulong **lastjmp)
{
ulong *p, *pbase, Cw, Yw, Ch;
uchar *Ybase, *Cbbase, *Crbase;
int i, bitspp;
bitspp = 6;
assert(w * bitspp / 8 <= 0x7FF);
pbase = p = (ulong *)malloc((h + 6) * 5 * sizeof(ulong));
assert(p);
Yw = w;
Ybase = (uchar *)pa;
Cw = w >> 1;
Ch = h >> 1;
Cbbase = Ybase + Yw * h;
Crbase = Cbbase + Cw * Ch;
*p++ = riscsync | riscsync_resync | riscsync_vre;
*p++ = 0;
*p++ = riscsync | riscsync_fm3;
*p++ = 0;
for (i = 0; i != h / 2; i++) {
*p++ = riscwrite123 | Yw | riscwrite_sol | riscwrite_eol;
*p++ = (Cw << 16) | Cw;
*p++ = (ulong)(Ybase + i * 2 * Yw);
*p++ = (ulong)(Cbbase + i * Cw); /* Do not interlace */
*p++ = (ulong)(Crbase + i * Cw);
}
*p++ = riscsync | riscsync_resync | riscsync_vro;
*p++ = 0;
*p++ = riscsync | riscsync_fm3;
*p++ = 0;
for (i = 0; i != h / 2; i++) {
*p++ = riscwrite1s23 | Yw | riscwrite_sol | riscwrite_eol;
*p++ = (Cw << 16) | Cw;
*p++ = (ulong)(Ybase + (i * 2 + 1) * Yw);
}
/* reset status. you really need two instructions ;-(. */
*p++ = riscjmp | (0xf << risclabelshift_reset);
*p++ = PADDR(p);
*p++ = riscjmp | riscirq | (fnum << risclabelshift_set);
*lastjmp = p;
return pbase;
}
static ulong *
riscplanar422(ulong pa, int fnum, int w, int h, ulong **lastjmp)
{
ulong *p, *pbase, Cw, Yw;
uchar *Ybase, *Cbbase, *Crbase;
int i, bpp;
bpp = 2;
assert(w * bpp <= 0x7FF);
pbase = p = (ulong *)malloc((h + 6) * 5 * sizeof(ulong));
assert(p);
Yw = w;
Ybase = (uchar *)pa;
Cw = w >> 1;
Cbbase = Ybase + Yw * h;
Crbase = Cbbase + Cw * h;
*p++ = riscsync | riscsync_resync | riscsync_vre;
*p++ = 0;
*p++ = riscsync | riscsync_fm3;
*p++ = 0;
for (i = 0; i != h / 2; i++) {
*p++ = riscwrite123 | Yw | riscwrite_sol | riscwrite_eol;
*p++ = (Cw << 16) | Cw;
*p++ = (ulong)(Ybase + i * 2 * Yw);
*p++ = (ulong)(Cbbase + i * 2 * Cw);
*p++ = (ulong)(Crbase + i * 2 * Cw);
}
*p++ = riscsync | riscsync_resync | riscsync_vro;
*p++ = 0;
*p++ = riscsync | riscsync_fm3;
*p++ = 0;
for (i = 0; i != h / 2; i++) {
*p++ = riscwrite123 | Yw | riscwrite_sol | riscwrite_eol;
*p++ = (Cw << 16) | Cw;
*p++ = (ulong)(Ybase + (i * 2 + 1) * Yw);
*p++ = (ulong)(Cbbase + (i * 2 + 1) * Cw);
*p++ = (ulong)(Crbase + (i * 2 + 1) * Cw);
}
/* reset status. you really need two instructions ;-(. */
*p++ = riscjmp | (0xf << risclabelshift_reset);
*p++ = PADDR(p);
*p++ = riscjmp | riscirq | (fnum << risclabelshift_set);
*lastjmp = p;
return pbase;
}
static ulong *
riscaudio(ulong pa, int nblocks, int bsize)
{
ulong *p, *pbase;
int i;
pbase = p = (ulong *)malloc((nblocks + 3) * 2 * sizeof(ulong));
assert(p);
*p++ = riscsync|riscsync_fm1;
*p++ = 0;
for (i = 0; i != nblocks; i++) {
*p++ = riscwrite | riscwrite_sol | riscwrite_eol | bsize | riscirq |
((i & 0xf) << risclabelshift_set) |
((~i & 0xf) << risclabelshift_reset);
*p++ = pa + i * bsize;
}
*p++ = riscsync | riscsync_vro;
*p++ = 0;
*p++ = riscjmp;
*p++ = PADDR(pbase);
USED(p);
return pbase;
}
static void
vactivate(Tv *tv, Frame *frames, int nframes)
{
Bt848 *bt848 = tv->bt848;
ilock(tv);
if (tv->frames) {
iunlock(tv);
error(Einuse);
}
poperror();
tv->frames = frames;
tv->nframes = nframes;
bt848->riscstrtadd = PADDR(tv->frames[0].fstart);
bt848->capctl |= capctl_captureodd|capctl_captureeven;
bt848->gpiodmactl |= gpiodmactl_fifoenable;
bt848->gpiodmactl |= gpiodmactl_riscenable;
iunlock(tv);
}
static void
vstart(Tv *tv, int nframes, int w, int h, int stride)
{
Frame *frames;
int bitspp, i, bpf;
if (nframes >= 0x10)
error(Ebadarg);
bitspp = getbitspp(tv);
bpf = w * h * bitspp / 8;
/* Add one as a spare. */
frames = (Frame *)malloc(nframes * sizeof(Frame));
assert(frames);
if (waserror()) {
for (i = 0; i != nframes; i++)
if (frames[i].fbase)
free(frames[i].fbase);
free(frames);
nexterror();
}
memset(frames, 0, nframes * sizeof(Frame));
for (i = 0; i != nframes; i++) {
if ((frames[i].fbase = (uchar *)malloc(bpf)) == nil)
error(Enomem);
switch (tv->cfmt) {
case colorfmt_YCbCr422:
frames[i].fstart = riscplanar422(PADDR(frames[i].fbase), i, w, h, &frames[i].fjmp);
break;
case colorfmt_YCbCr411:
frames[i].fstart = riscplanar411(PADDR(frames[i].fbase),
i, w, h, &frames[i].fjmp);
break;
case colorfmt_rgb16:
frames[i].fstart = riscpacked(PADDR(frames[i].fbase), i,
w * bitspp / 8, h, stride * bitspp / 8,
&frames[i].fjmp);
break;
default:
panic("vstart: Unsupport colorformat");
}
}
for (i = 0; i != nframes; i++)
*frames[i].fjmp = PADDR(i == nframes - 1? frames[0].fstart:
frames[i + 1].fstart);
vactivate(tv, frames, nframes);
}
static void
astart(Tv *tv, char *input, uint rate, uint nab, uint nasz)
{
Bt848 *bt878 = tv->bt878;
ulong *arisc;
int selector;
uchar *abuf;
int s, d;
if (bt878 == nil || tv->amux == nil)
error("#V: Card does not support audio");
selector = 0;
if (!strcmp(input, "tv"))
selector = asel_tv;
else if (!strcmp(input, "radio"))
selector = asel_radio;
else if (!strcmp(input, "mic"))
selector = asel_mic;
else if (!strcmp(input, "smxc"))
selector = asel_smxc;
else
error("#V: Invalid input");
if (nasz > 0xfff)
error("#V: Audio block size too big (max 0xfff)");
abuf = (uchar *)malloc(nab * nasz * sizeof(uchar));
assert(abuf);
arisc = riscaudio(PADDR(abuf), nab, nasz);
ilock(tv);
if (tv->arisc) {
iunlock(tv);
free(abuf);
free(arisc);
error(Einuse);
}
tv->arisc = arisc;
tv->abuf = abuf;
tv->nablocks = nab;
tv->absize = nasz;
bt878->riscstrtadd = PADDR(tv->arisc);
bt878->packetlen = (nab << 16) | nasz;
bt878->intmask = intstat_scerr | intstat_ocerr | intstat_risci |
intstat_pabort | intstat_riperr | intstat_pperr |
intstat_fdsr | intstat_ftrgt | intstat_fbus;
/* Assume analog, 16bpp */
for (s = 0; s < 16; s++)
if (rate << s > Hwbase_ad * 4 / 15)
break;
for (d = 15; d >= 4; d--)
if (rate << s < Hwbase_ad * 4 / d)
break;
print("astart: sampleshift %d, decimation %d\n", s, d);
tv->narblocks = 0;
bt878->gpiodmactl = gpiodmactl_fifoenable |
gpiodmactl_riscenable | gpiodmactl_acapenable |
gpiodmactl_daes2 | /* gpiodmactl_apwrdn | */
gpiodmactl_daiomda | d << 8 | 9 << 28 | selector << 24;
print("dmactl %.8ulX\n", bt878->gpiodmactl);
iunlock(tv);
}
static void
astop(Tv *tv)
{
Bt848 *bt878 = tv->bt878;
ilock(tv);
if (tv->aref.ref > 0) {
iunlock(tv);
error(Einuse);
}
if (tv->abuf) {
bt878->gpiodmactl &= ~gpiodmactl_riscenable;
bt878->gpiodmactl &= ~gpiodmactl_fifoenable;
free(tv->abuf);
tv->abuf = nil;
free(tv->arisc);
tv->arisc = nil;
}
iunlock(tv);
}
static void
vgastart(Tv *tv, ulong pa, int stride)
{
Frame *frame;
frame = (Frame *)malloc(sizeof(Frame));
assert(frame);
if (waserror()) {
free(frame);
nexterror();
}
frame->fbase = nil;
frame->fstart = riscpacked(pa, 0, ntsc_hactive * getbitspp(tv) / 8,
ntsc_vactive, stride * getbitspp(tv) / 8, &frame->fjmp);
*frame->fjmp = PADDR(frame->fstart);
vactivate(tv, frame, 1);
}
static void
vstop(Tv *tv)
{
Bt848 *bt848 = tv->bt848;
ilock(tv);
if (tv->fref.ref > 0) {
iunlock(tv);
error(Einuse);
}
if (tv->frames) {
int i;
bt848->gpiodmactl &= ~gpiodmactl_riscenable;
bt848->gpiodmactl &= ~gpiodmactl_fifoenable;
bt848->capctl &= ~(capctl_captureodd|capctl_captureeven);
for (i = 0; i != tv->nframes; i++)
if (tv->frames[i].fbase)
free(tv->frames[i].fbase);
free(tv->frames);
tv->frames = nil;
}
iunlock(tv);
}
static long hrcfreq[] = { /* HRC CATV frequencies */
0, 7200, 5400, 6000, 6600, 7800, 8400, 17400,
18000, 18600, 19200, 19800, 20400, 21000, 12000, 12600,
13200, 13800, 14400, 15000, 15600, 16200, 16800, 21600,
22200, 22800, 23400, 24000, 24600, 25200, 25800, 26400,
27000, 27600, 28200, 28800, 29400, 30000, 30600, 31200,
31800, 32400, 33000, 33600, 34200, 34800, 35400, 36000,
36600, 37200, 37800, 38400, 39000, 39600, 40200, 40800,
41400, 42000, 42600, 43200, 43800, 44400, 45000, 45600,
46200, 46800, 47400, 48000, 48600, 49200, 49800, 50400,
51000, 51600, 52200, 52800, 53400, 54000, 54600, 55200,
55800, 56400, 57000, 57600, 58200, 58800, 59400, 60000,
60600, 61200, 61800, 62400, 63000, 63600, 64200, 9000,
9600, 10200, 10800, 11400, 64800, 65400, 66000, 66600,
67200, 67800, 68400, 69000, 69600, 70200, 70800, 71400,
72000, 72600, 73200, 73800, 74400, 75000, 75600, 76200,
76800, 77400, 78000, 78600, 79200, 79800,
};
static void
frequency(Tv *tv, int channel, int finetune)
{
Tuner *tuner = tv->tuner;
long freq;
ushort div;
uchar cfg;
if (channel < 0 || channel > nelem(hrcfreq))
error(Ebadarg);
freq = (hrcfreq[channel] * Freqmultiplier) / 100;
if (freq < tuner->freq_vhfh)
cfg = tuner->VHF_L;
else if (freq < tuner->freq_uhf)
cfg = tuner->VHF_H;
else
cfg = tuner->UHF;
div = (freq + tuner->offs + finetune) & 0x7fff;
if (!i2cwrite(tv, tv->i2ctuneraddr, (div >> 8) & 0x7f, div, 1))
error(Eio);
if (!i2cwrite(tv, tv->i2ctuneraddr, tuner->cfg, cfg, 1))
error(Eio);
tv->channel = channel;
if (tv->msp)
msptune(tv);
}
static struct {
char *cmode;
ulong realmode;
ulong cbits;
} colormodes[] = {
{ "RGB16", colorfmt_rgb16, colorfmt_rgb16, },
{ "YCbCr422", colorfmt_YCbCr422, colorfmt_YCbCr422, },
{ "YCbCr411", colorfmt_YCbCr411, colorfmt_YCbCr422, },
};
static void
colormode(Tv *tv, char *colormode)
{
Bt848 *bt848 = tv->bt848;
int i;
for (i = 0; i != nelem(colormodes); i++)
if (!strcmp(colormodes[i].cmode, colormode))
break;
if (i == nelem(colormodes))
error(Ebadarg);
tv->cfmt = colormodes[i].realmode;
bt848->colorfmt = colormodes[i].cbits;
}
static int
getbitspp(Tv *tv)
{
switch (tv->cfmt) {
case colorfmt_rgb16:
case colorfmt_YCbCr422:
return 16;
case colorfmt_YCbCr411:
return 12;
default:
error("getbitspp: Unsupport color format\n");
}
return -1;
}
static char *
getcolormode(ulong cmode)
{
switch (cmode) {
case colorfmt_rgb16:
return "RGB16";
case colorfmt_YCbCr411:
return "YCbCr411";
case colorfmt_YCbCr422:
return (cmode == colorfmt_YCbCr422)? "YCbCr422": "YCbCr411";
default:
error("getcolormode: Unsupport color format\n");
}
return nil;
}
static void
i2c_set(Tv *tv, int scl, int sda)
{
Bt848 *bt848 = tv->bt848;
ulong d;
bt848->i2c = (scl << 1) | sda;
d = bt848->i2c;
USED(d);
microdelay(i2c_delay);
}
static uchar
i2c_getsda(Tv *tv)
{
Bt848 *bt848 = tv->bt848;
return bt848->i2c & i2c_sda;
}
static void
i2c_start(Tv *tv)
{
i2c_set(tv, 0, 1);
i2c_set(tv, 1, 1);
i2c_set(tv, 1, 0);
i2c_set(tv, 0, 0);
}
static void
i2c_stop(Tv *tv)
{
i2c_set(tv, 0, 0);
i2c_set(tv, 1, 0);
i2c_set(tv, 1, 1);
}
static void
i2c_bit(Tv *tv, int sda)
{
i2c_set(tv, 0, sda);
i2c_set(tv, 1, sda);
i2c_set(tv, 0, sda);
}
static int
i2c_getack(Tv *tv)
{
int ack;
i2c_set(tv, 0, 1);
i2c_set(tv, 1, 1);
ack = i2c_getsda(tv);
i2c_set(tv, 0, 1);
return ack;
}
static int
i2c_wr8(Tv *tv, uchar d, int wait)
{
int i, ack;
i2c_set(tv, 0, 0);
for (i = 0; i != 8; i++) {
i2c_bit(tv, (d & 0x80)? 1: 0);
d <<= 1;
}
if (wait)
microdelay(wait);
ack = i2c_getack(tv);
return ack == 0;
}
static uchar
i2c_rd8(Tv *tv, int lastbyte)
{
int i;
uchar d;
d = 0;
i2c_set(tv, 0, 1);
for (i = 0; i != 8; i++) {
i2c_set(tv, 1, 1);
d <<= 1;
if (i2c_getsda(tv))
d |= 1;
i2c_set(tv, 0, 1);
}
i2c_bit(tv, lastbyte? 1: 0);
return d;
}
static int
mspsend(Tv *tv, uchar *cmd, int ncmd)
{
int i, j, delay;
for (i = 0; i != 3; i++) {
delay = 2000;
i2c_start(tv);
for (j = 0; j != ncmd; j++) {
if (!i2c_wr8(tv, cmd[j], delay))
break;
delay = 0;
}
i2c_stop(tv);
if (j == ncmd)
return 1;
microdelay(10000);
print("mspsend: retrying\n");
}
return 0;
}
static int
mspwrite(Tv *tv, uchar sub, ushort reg, ushort v)
{
uchar b[6];
b[0] = i2c_msp3400;
b[1] = sub;
b[2] = reg >> 8;
b[3] = reg;
b[4] = v >> 8;
b[5] = v;
return mspsend(tv, b, sizeof b);
}
static int
mspread(Tv *tv, uchar sub, ushort reg, ushort *data)
{
uchar b[4];
int i;
b[0] = i2c_msp3400;
b[1] = sub;
b[2] = reg >> 8;
b[3] = reg;
for (i = 0; i != 3; i++) {
i2c_start(tv);
if (!i2c_wr8(tv, b[0], 2000) ||
!i2c_wr8(tv, b[1] | 1, 0) ||
!i2c_wr8(tv, b[2], 0) ||
!i2c_wr8(tv, b[3], 0)) {
i2c_stop(tv);
microdelay(10000);
print("retrying\n");
continue;
}
i2c_start(tv);
if (!i2c_wr8(tv, b[0] | 1, 2000)) {
i2c_stop(tv);
continue;
}
*data = i2c_rd8(tv, 0) << 8;
*data |= i2c_rd8(tv, 1);
i2c_stop(tv);
return 1;
}
return 0;
}
static uchar mspt_reset[] = { i2c_msp3400, 0, 0x80, 0 };
static uchar mspt_on[] = { i2c_msp3400, 0, 0, 0 };
static int
mspreset(Tv *tv)
{
ushort v, p;
Bt848 *bt848 = tv->bt848;
ulong b;
b = 1 << 5;
gpioenable(tv, ~b, b);
gpiowrite(tv, ~b, 0);
microdelay(2500);
gpiowrite(tv, ~b, b);
bt848->i2c = 0x80;
microdelay(2000);
mspsend(tv, mspt_reset, sizeof mspt_reset);
microdelay(2000);
if (!mspsend(tv, mspt_on, sizeof mspt_on)) {
print("#V: Cannot find MSP34x5G on the I2C bus (on)\n");
return 0;
}
microdelay(2000);
if (!mspread(tv, msp_bbp, 0x001e, &v)) {
print("#V: Cannot read MSP34xG5 chip version\n");
return 0;
}
if (!mspread(tv, msp_bbp, 0x001f, &p)) {
print("#V: Cannot read MSP34xG5 product code\n");
return 0;
}
print("#V: MSP34%dg ROM %.d, %d.%d\n",
(uchar)(p >> 8), (uchar)p, (uchar)(v >> 8), (uchar)v);
tv->msp = 1;
return 1;
}
static void
mspvolume(Tv *tv, int mute, int l, int r)
{
short v, d;
ushort b;
if (mute) {
v = 0;
b = 0;
}
else {
tv->aleft = l;
tv->aright = r;
d = v = max(l, r);
if (d == 0)
d++;
b = ((r - l) * 0x7f) / d;
}
mspwrite(tv, msp_bbp, 0, v << 8);
mspwrite(tv, msp_bbp, 7, v? 0x4000: 0);
mspwrite(tv, msp_bbp, 1, b << 8);
}
static char *
mspaformat(int f)
{
switch (f) {
case 0:
return "unknown";
case 2:
case 0x20:
case 0x30:
return "M-BTSC";
case 3:
return "B/G-FM";
case 4:
case 9:
case 0xB:
return "L-AM/NICAM D/Kn";
case 8:
return "B/G-NICAM";
case 0xA:
return "I";
case 0x40:
return "FM-Radio";
}
return "unknown format";
}
static void
msptune(Tv *tv)
{
ushort d, s, nicam;
int i;
mspvolume(tv, 1, 0, 0);
if (!mspwrite(tv, msp_dem, 0x0030, 0x2033))
error("#V: Cannot set MODUS register");
if (!mspwrite(tv, msp_bbp, 0x0008, 0x0320))
error("#V: Cannot set loadspeaker input");
if (!mspwrite(tv, msp_dem, 0x0040, 0x0001))
error("#V: Cannot set I2S clock freq");
if (!mspwrite(tv, msp_bbp, 0x000d, 0x1900))
error("#V: Cannot set SCART prescale");
if (!mspwrite(tv, msp_bbp, 0x000e, 0x2403))
error("#V: Cannot set FM/AM prescale");
if (!mspwrite(tv, msp_bbp, 0x0010, 0x5a00))
error("#V: Cannot set NICAM prescale");
if (!mspwrite(tv, msp_dem, 0x0020, 0x0001))
error("#V: Cannot start auto detect");
for (d = (ushort)-1, i = 0; i != 10; i++) {
if (!mspread(tv, msp_dem, 0x007e, &d))
error("#V: Cannot get autodetect info MSP34xG5");
if (d == 0 || d < 0x800)
break;
delay(50);
}
if (!mspread(tv, msp_dem, 0x0200, &s))
error("#V: Cannot get status info MSP34xG5");
mspvolume(tv, 0, tv->aleft, tv->aright);
nicam = ((s >> 4) & 2) | ((s >> 9) & 1);
snprint(tv->ainfo, sizeof tv->ainfo, "%s %s %s",
mspaformat(d), (s & (1 << 6))? "stereo": "mono",
nicamstate[nicam]);
}
static void
i2cscan(Tv *tv)
{
int i, ack;
for (i = 0; i < 0x100; i += 2) {
i2c_start(tv);
ack = i2c_wr8(tv, i, 0);
i2c_stop(tv);
if (ack)
print("i2c device @%.2uX\n", i);
}
for (i = 0xf0; i != 0xff; i++) {
i2c_start(tv);
ack = i2c_wr8(tv, i, 0);
i2c_stop(tv);
if (ack)
print("i2c device may be at @%.2uX\n", i);
}
}
static void
gpioenable(Tv *tv, ulong mask, ulong data)
{
Bt848 *bt848 = tv->bt848;
bt848->gpioouten = (bt848->gpioouten & mask) | data;
}
static void
gpiowrite(Tv *tv, ulong mask, ulong data)
{
Bt848 *bt848 = tv->bt848;
bt848->gpiodata[0] = (bt848->gpiodata[0] & mask) | data;
}
static void
alteraoutput(Tv *tv)
{
if (tv->gpiostate == Gpiooutput)
return;
gpioenable(tv, ~0xffffff, 0x56ffff);
microdelay(10);
tv->gpiostate = Gpiooutput;
}
static void
alterainput(Tv *tv)
{
if (tv->gpiostate == Gpioinput)
return;
gpioenable(tv, ~0xffffff, 0x570000);
microdelay(10);
tv->gpiostate = Gpioinput;
}
static void
alterareg(Tv *tv, ulong reg)
{
if (tv->alterareg == reg)
return;
gpiowrite(tv, ~0x56ffff, (reg & 0x54ffff) | tv->alteraclock);
microdelay(10);
tv->alterareg = reg;
}
static void
alterawrite(Tv *tv, ulong reg, ushort data)
{
alteraoutput(tv);
alterareg(tv, reg);
tv->alteraclock ^= 0x20000;
gpiowrite(tv, ~0x56ffff, (reg & 0x540000) | data | tv->alteraclock);
microdelay(10);
}
static void
alteraread(Tv *tv, int reg, ushort *data)
{
Bt848 *bt848 = tv->bt848;
if (tv->alterareg != reg) {
alteraoutput(tv);
alterareg(tv, reg);
}
else {
gpioenable(tv, ~0xffffff, 0x560000);
microdelay(10);
}
alterainput(tv);
gpiowrite(tv, ~0x570000, (reg & 0x560000) | tv->alteraclock);
microdelay(10);
*data = (ushort)bt848->gpiodata[0];
microdelay(10);
}
static void
kfirloadu(Tv *tv, uchar *u, int ulen)
{
Bt848 *bt848 = tv->bt848;
int i, j;
ilock(&tv->kfirlock);
bt848->gpioouten &= 0xff000000;
bt848->gpioouten |= gpio_altera_data |
gpio_altera_clock | gpio_altera_nconfig;
bt848->gpiodata[0] &= 0xff000000;
microdelay(10);
bt848->gpiodata[0] |= gpio_altera_nconfig;
microdelay(10);
/* Download the microcode */
for (i = 0; i != ulen; i++)
for (j = 0; j != 8; j++) {
bt848->gpiodata[0] &= ~(gpio_altera_clock|gpio_altera_data);
if (u[i] & 1)
bt848->gpiodata[0] |= gpio_altera_data;
bt848->gpiodata[0] |= gpio_altera_clock;
u[i] >>= 1;
}
bt848->gpiodata[0] &= ~gpio_altera_clock;
microdelay(100);
/* Initialize. */
for (i = 0; i != 30; i++) {
bt848->gpiodata[0] &= ~gpio_altera_clock;
bt848->gpiodata[0] |= gpio_altera_clock;
}
bt848->gpiodata[0] &= ~(gpio_altera_clock|gpio_altera_data);
iunlock(&tv->kfirlock);
tv->gpiostate = Gpioinit;
}
static void
kfirreset(Tv *tv)
{
alterawrite(tv, 0, 0);
microdelay(10);
alterawrite(tv, 0x40000, 0);
microdelay(10);
alterawrite(tv, 0x40006, 0x80);
microdelay(10);
alterawrite(tv, 8, 1);
microdelay(10);
alterawrite(tv, 0x40004, 2);
microdelay(10);
alterawrite(tv, 4, 3);
microdelay(3);
}
static int
kfirinitialize(Tv *tv)
{
/* Initialize parameters? */
tv->gpiostate = Gpioinit;
tv->alterareg = -1;
tv->alteraclock = 0x20000;
kfirloadu(tv, hcwAMC, sizeof hcwAMC);
kfirreset(tv);
return 1;
}