#ifdef CS4280_DEBUG
#ifndef MIDI_READY
#define MIDI_READY
#endif
#endif
#ifdef MIDI_READY
#include "midi.h"
#endif
#if defined(CS4280_DEBUG)
#define DPRINTF(x) if (cs4280debug) printf x
#define DPRINTFN(n,x) if (cs4280debug>(n)) printf x
int cs4280debug = 0;
#else
#define DPRINTF(x)
#define DPRINTFN(n,x)
#endif
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/malloc.h>
#include <sys/device.h>
#include <dev/pci/pcidevs.h>
#include <dev/pci/pcivar.h>
#include <dev/pci/cs4280reg.h>
#include <sys/audioio.h>
#include <dev/audio_if.h>
#include <dev/ic/ac97.h>
#include <machine/bus.h>
#define CSCC_PCI_BA0 0x10
#define CSCC_PCI_BA1 0x14
struct cs4280_dma {
bus_dmamap_t map;
caddr_t addr;
caddr_t dum;
bus_dma_segment_t segs[1];
int nsegs;
size_t size;
struct cs4280_dma *next;
};
#define DMAADDR(p) ((p)->map->dm_segs[0].ds_addr)
#define BUFADDR(p) ((void *)((p)->dum))
#define KERNADDR(p) ((void *)((p)->addr))
struct cs4280_softc {
struct device sc_dev;
pci_intr_handle_t * sc_ih;
bus_space_tag_t ba0t;
bus_space_handle_t ba0h;
bus_space_tag_t ba1t;
bus_space_handle_t ba1h;
bus_dma_tag_t sc_dmatag;
struct cs4280_dma *sc_dmas;
void (*sc_pintr)(void *);
void *sc_parg;
char *sc_ps, *sc_pe, *sc_pn;
int sc_pcount;
int sc_pi;
struct cs4280_dma *sc_pdma;
char *sc_pbuf;
#ifdef DIAGNOSTIC
char sc_prun;
#endif
void (*sc_rintr)(void *);
void *sc_rarg;
char *sc_rs, *sc_re, *sc_rn;
int sc_rcount;
int sc_ri;
struct cs4280_dma *sc_rdma;
char *sc_rbuf;
int sc_rparam;
#ifdef DIAGNOSTIC
char sc_rrun;
#endif
#if NMIDI > 0
void (*sc_iintr)(void *, int);
void (*sc_ointr)(void *);
void *sc_arg;
#endif
u_int32_t pctl;
u_int32_t cctl;
struct ac97_codec_if *codec_if;
struct ac97_host_if host_if;
u_int16_t ac97_reg[CS4280_SAVE_REG_MAX + 1];
};
#define BA0READ4(sc, r) bus_space_read_4((sc)->ba0t, (sc)->ba0h, (r))
#define BA0WRITE4(sc, r, x) bus_space_write_4((sc)->ba0t, (sc)->ba0h, (r), (x))
#define BA1READ4(sc, r) bus_space_read_4((sc)->ba1t, (sc)->ba1h, (r))
#define BA1WRITE4(sc, r, x) bus_space_write_4((sc)->ba1t, (sc)->ba1h, (r), (x))
int cs4280_match(struct device *, void *, void *);
void cs4280_attach(struct device *, struct device *, void *);
int cs4280_activate(struct device *, int);
void cs4280_attachhook(struct device *);
int cs4280_intr(void *);
void cs4280_reset(void *);
int cs4280_download_image(struct cs4280_softc *);
int cs4280_download(struct cs4280_softc *, const u_int32_t *, u_int32_t, u_int32_t);
int cs4280_allocmem(struct cs4280_softc *, size_t, size_t,
struct cs4280_dma *);
int cs4280_freemem(struct cs4280_softc *, struct cs4280_dma *);
#ifdef CS4280_DEBUG
int cs4280_check_images(struct cs4280_softc *);
int cs4280_checkimage(struct cs4280_softc *, u_int32_t *, u_int32_t,
u_int32_t);
#endif
struct cfdriver clcs_cd = {
NULL, "clcs", DV_DULL
};
const struct cfattach clcs_ca = {
sizeof(struct cs4280_softc), cs4280_match, cs4280_attach, NULL,
cs4280_activate
};
int cs4280_init(struct cs4280_softc *, int);
int cs4280_init2(struct cs4280_softc *, int);
int cs4280_open(void *, int);
void cs4280_close(void *);
int cs4280_set_params(void *, int, int, struct audio_params *, struct audio_params *);
int cs4280_round_blocksize(void *, int);
int cs4280_halt_output(void *);
int cs4280_halt_input(void *);
int cs4280_mixer_set_port(void *, mixer_ctrl_t *);
int cs4280_mixer_get_port(void *, mixer_ctrl_t *);
int cs4280_query_devinfo(void *addr, mixer_devinfo_t *dip);
void *cs4280_malloc(void *, int, size_t, int, int);
void cs4280_free(void *, void *, int);
int cs4280_trigger_output(void *, void *, void *, int, void (*)(void *),
void *, struct audio_params *);
int cs4280_trigger_input(void *, void *, void *, int, void (*)(void *),
void *, struct audio_params *);
void cs4280_set_dac_rate(struct cs4280_softc *, int );
void cs4280_set_adc_rate(struct cs4280_softc *, int );
int cs4280_get_portnum_by_name(struct cs4280_softc *, char *, char *,
char *);
int cs4280_src_wait(struct cs4280_softc *);
int cs4280_attach_codec(void *sc, struct ac97_codec_if *);
int cs4280_read_codec(void *sc, u_int8_t a, u_int16_t *d);
int cs4280_write_codec(void *sc, u_int8_t a, u_int16_t d);
void cs4280_reset_codec(void *sc);
void cs4280_clear_fifos(struct cs4280_softc *);
#if NMIDI > 0
void cs4280_midi_close(void *);
void cs4280_midi_getinfo(void *, struct midi_info *);
int cs4280_midi_open(void *, int, void (*)(void *, int),
void (*)(void *), void *);
int cs4280_midi_output(void *, int);
#endif
const struct audio_hw_if cs4280_hw_if = {
.open = cs4280_open,
.close = cs4280_close,
.set_params = cs4280_set_params,
.round_blocksize = cs4280_round_blocksize,
.halt_output = cs4280_halt_output,
.halt_input = cs4280_halt_input,
.set_port = cs4280_mixer_set_port,
.get_port = cs4280_mixer_get_port,
.query_devinfo = cs4280_query_devinfo,
.allocm = cs4280_malloc,
.freem = cs4280_free,
.trigger_output = cs4280_trigger_output,
.trigger_input = cs4280_trigger_input,
};
#if NMIDI > 0
const struct midi_hw_if cs4280_midi_hw_if = {
cs4280_midi_open,
cs4280_midi_close,
cs4280_midi_output,
0,
cs4280_midi_getinfo,
0,
};
#endif
const struct pci_matchid cs4280_devices[] = {
{ PCI_VENDOR_CIRRUS, PCI_PRODUCT_CIRRUS_CS4280 },
{ PCI_VENDOR_CIRRUS, PCI_PRODUCT_CIRRUS_CS4610 },
{ PCI_VENDOR_CIRRUS, PCI_PRODUCT_CIRRUS_CS4615 },
};
int
cs4280_match(struct device *parent, void *ma, void *aux)
{
return (pci_matchbyid((struct pci_attach_args *)aux, cs4280_devices,
nitems(cs4280_devices)));
}
int
cs4280_read_codec(void *sc_, u_int8_t add, u_int16_t *data)
{
struct cs4280_softc *sc = sc_;
int n;
DPRINTFN(5,("read_codec: add=0x%02x ", add));
BA0READ4(sc, CS4280_ACSDA);
BA0WRITE4(sc, CS4280_ACCAD, add);
BA0WRITE4(sc, CS4280_ACCDA, 0);
BA0WRITE4(sc, CS4280_ACCTL,
ACCTL_RSTN | ACCTL_ESYN | ACCTL_VFRM | ACCTL_CRW | ACCTL_DCV );
if (cs4280_src_wait(sc) < 0) {
printf("%s: AC97 read prob. (DCV!=0) for add=0x%02x\n",
sc->sc_dev.dv_xname, add);
return (1);
}
n = 0;
while (!(BA0READ4(sc, CS4280_ACSTS) & ACSTS_VSTS)) {
delay(1);
while (++n > 1000) {
printf("%s: AC97 read fail (VSTS==0) for add=0x%02x\n",
sc->sc_dev.dv_xname, add);
return (1);
}
}
*data = BA0READ4(sc, CS4280_ACSDA);
DPRINTFN(5,("data=0x%04x\n", *data));
return (0);
}
int
cs4280_write_codec(void *sc_, u_int8_t add, u_int16_t data)
{
struct cs4280_softc *sc = sc_;
DPRINTFN(5,("write_codec: add=0x%02x data=0x%04x\n", add, data));
BA0WRITE4(sc, CS4280_ACCAD, add);
BA0WRITE4(sc, CS4280_ACCDA, data);
BA0WRITE4(sc, CS4280_ACCTL,
ACCTL_RSTN | ACCTL_ESYN | ACCTL_VFRM | ACCTL_DCV );
if (cs4280_src_wait(sc) < 0) {
printf("%s: AC97 write fail (DCV!=0) for add=0x%02x data="
"0x%04x\n", sc->sc_dev.dv_xname, add, data);
return (1);
}
return (0);
}
int
cs4280_src_wait(struct cs4280_softc *sc)
{
int n;
n = 0;
while ((BA0READ4(sc, CS4280_ACCTL) & ACCTL_DCV)) {
delay(1000);
if (++n > 1000)
return (-1);
}
return (0);
}
void
cs4280_set_adc_rate(struct cs4280_softc *sc, int rate)
{
u_int32_t cci,cpi,cnt,cx,cy, tmp1;
u_int16_t csrc, cgl, cdlay;
if (rate < 8000)
rate = 8000;
if (rate > 48000)
rate = 48000;
cx = rate << 16;
cci = cx / 48000;
cx -= cci * 48000;
cx <<= 7;
cci <<= 7;
cci += cx / 48000;
cci = - cci;
cx = 48000 << 16;
cpi = cx / rate;
cx -= cpi * rate;
cx <<= 10;
cpi <<= 10;
cy = cx / rate;
cpi += cy;
cx -= cy * rate;
cy = cx / 200;
csrc = cx - 200*cy;
cdlay = ((48000 * 24) + rate - 1) / rate;
#if 0
cdlay &= 0x3fff;
#endif
cnt = rate << 16;
cnt /= 24000;
cgl = 1;
for (tmp1 = 2; tmp1 <= 64; tmp1 *= 2) {
if (((rate / tmp1) * tmp1) != rate)
cgl *= 2;
}
if (((rate / 3) * 3) != rate)
cgl *= 3;
for (tmp1 = 5; tmp1 <= 125; tmp1 *= 5) {
if (((rate / tmp1) * tmp1) != rate)
cgl *= 5;
}
#if 0
tmp1 = BA1READ4(sc, CS4280_CSRC) & ~CSRC_MASK;
tmp1 |= csrc<<16;
BA1WRITE4(sc, CS4280_CSRC, tmp1);
#else
BA1WRITE4(sc, CS4280_CSRC, CS4280_MK_CSRC(csrc, cy));
#endif
#if 0
tmp1 = BA1READ4(sc, CS4280_CCI) & ~CCI_MASK;
tmp1 |= cci<<16;
BA1WRITE4(sc, CS4280_CCI, tmp1);
#else
BA1WRITE4(sc, CS4280_CCI, cci);
#endif
tmp1 = BA1READ4(sc, CS4280_CD) & ~CD_MASK;
tmp1 |= cdlay <<18;
BA1WRITE4(sc, CS4280_CD, tmp1);
BA1WRITE4(sc, CS4280_CPI, cpi);
tmp1 = BA1READ4(sc, CS4280_CGL) & ~CGL_MASK;
tmp1 |= cgl;
BA1WRITE4(sc, CS4280_CGL, tmp1);
BA1WRITE4(sc, CS4280_CNT, cnt);
tmp1 = BA1READ4(sc, CS4280_CGC) & ~CGC_MASK;
tmp1 |= cgl;
BA1WRITE4(sc, CS4280_CGC, tmp1);
}
void
cs4280_set_dac_rate(struct cs4280_softc *sc, int rate)
{
int32_t ppi;
int16_t psrc;
u_int32_t px, py;
if (rate < 8000)
rate = 8000;
if (rate > 48000)
rate = 48000;
px = rate << 16;
ppi = px/48000;
px -= ppi*48000;
ppi <<= 10;
px <<= 10;
py = px / 48000;
ppi += py;
px -= py*48000;
py = px/200;
px -= py*200;
psrc = px;
#if 0
px = BA1READ4(sc, CS4280_PSRC) & ~PSRC_MASK;
BA1WRITE4(sc, CS4280_PSRC,
( ((psrc<<16) & PSRC_MASK) | px ));
#else
BA1WRITE4(sc, CS4280_PSRC, CS4280_MK_PSRC(psrc,py));
#endif
BA1WRITE4(sc, CS4280_PPI, ppi);
}
void
cs4280_attachhook(struct device *self)
{
struct cs4280_softc *sc = (struct cs4280_softc *)self;
mixer_ctrl_t ctl;
if (cs4280_init2(sc, 1) != 0)
return;
printf("%s: firmware loaded\n", sc->sc_dev.dv_xname);
ctl.type = AUDIO_MIXER_ENUM;
ctl.un.ord = 0;
ctl.dev = cs4280_get_portnum_by_name(sc, AudioCoutputs,
AudioNmaster, AudioNmute);
cs4280_mixer_set_port(sc, &ctl);
ctl.dev = cs4280_get_portnum_by_name(sc, AudioCinputs,
AudioNdac, AudioNmute);
cs4280_mixer_set_port(sc, &ctl);
ctl.dev = cs4280_get_portnum_by_name(sc, AudioCinputs,
AudioNcd, AudioNmute);
cs4280_mixer_set_port(sc, &ctl);
audio_attach_mi(&cs4280_hw_if, sc, NULL, &sc->sc_dev);
#if NMIDI > 0
midi_attach_mi(&cs4280_midi_hw_if, sc, &sc->sc_dev);
#endif
}
void
cs4280_attach(struct device *parent, struct device *self, void *aux)
{
struct cs4280_softc *sc = (struct cs4280_softc *) self;
struct pci_attach_args *pa = (struct pci_attach_args *) aux;
pci_chipset_tag_t pc = pa->pa_pc;
char const *intrstr;
pci_intr_handle_t ih;
u_int32_t mem;
if (pci_mapreg_map(pa, CSCC_PCI_BA0,
PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT, 0,
&sc->ba0t, &sc->ba0h, NULL, NULL, 0)) {
printf(": can't map BA0 space\n");
return;
}
if (pci_mapreg_map(pa, CSCC_PCI_BA1,
PCI_MAPREG_TYPE_MEM | PCI_MAPREG_MEM_TYPE_32BIT, 0,
&sc->ba1t, &sc->ba1h, NULL, NULL, 0)) {
printf(": can't map BA1 space\n");
return;
}
sc->sc_dmatag = pa->pa_dmat;
pci_set_powerstate(pc, pa->pa_tag, PCI_PMCSR_STATE_D0);
mem = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_BHLC_REG);
if ( PCI_LATTIMER(mem) < 32 ) {
mem &= 0xffff00ff;
mem |= 0x00002000;
pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_BHLC_REG, mem);
}
if (pci_intr_map(pa, &ih)) {
printf(": couldn't map interrupt\n");
return;
}
intrstr = pci_intr_string(pc, ih);
sc->sc_ih = pci_intr_establish(pc, ih, IPL_AUDIO | IPL_MPSAFE,
cs4280_intr, sc, sc->sc_dev.dv_xname);
if (sc->sc_ih == NULL) {
printf(": couldn't establish interrupt");
if (intrstr != NULL)
printf(" at %s", intrstr);
printf("\n");
return;
}
printf(": %s\n", intrstr);
if (cs4280_init(sc, 1) != 0)
return;
config_mountroot(self, cs4280_attachhook);
sc->host_if.arg = sc;
sc->host_if.attach = cs4280_attach_codec;
sc->host_if.read = cs4280_read_codec;
sc->host_if.write = cs4280_write_codec;
sc->host_if.reset = cs4280_reset_codec;
if (ac97_attach(&sc->host_if) != 0) {
printf("%s: ac97_attach failed\n", sc->sc_dev.dv_xname);
return;
}
}
int
cs4280_intr(void *p)
{
struct cs4280_softc *sc = p;
u_int32_t intr, mem;
char * empty_dma;
int handled = 0;
mtx_enter(&audio_lock);
intr = BA0READ4(sc, CS4280_HISR);
BA0WRITE4(sc, CS4280_HICR, HICR_CHGM | HICR_IEV);
if (intr & HISR_PINT) {
handled = 1;
mem = BA1READ4(sc, CS4280_PFIE);
BA1WRITE4(sc, CS4280_PFIE, (mem & ~PFIE_PI_MASK) | PFIE_PI_DISABLE);
if (sc->sc_pintr) {
if ((sc->sc_pi%sc->sc_pcount) == 0)
sc->sc_pintr(sc->sc_parg);
} else {
printf("unexpected play intr\n");
}
++sc->sc_pi;
empty_dma = sc->sc_pdma->addr;
if (sc->sc_pi&1)
empty_dma += CS4280_ICHUNK;
memcpy(empty_dma, sc->sc_pn, CS4280_ICHUNK);
sc->sc_pn += CS4280_ICHUNK;
if (sc->sc_pn >= sc->sc_pe)
sc->sc_pn = sc->sc_ps;
BA1WRITE4(sc, CS4280_PFIE, mem);
}
if (intr & HISR_CINT) {
int i;
int16_t rdata;
handled = 1;
mem = BA1READ4(sc, CS4280_CIE);
BA1WRITE4(sc, CS4280_CIE, (mem & ~CIE_CI_MASK) | CIE_CI_DISABLE);
++sc->sc_ri;
empty_dma = sc->sc_rdma->addr;
if ((sc->sc_ri&1) == 0)
empty_dma += CS4280_ICHUNK;
switch(sc->sc_rparam) {
case CF_16BIT_STEREO:
memcpy(sc->sc_rn, empty_dma, CS4280_ICHUNK);
sc->sc_rn += CS4280_ICHUNK;
break;
case CF_16BIT_MONO:
for (i = 0; i < 512; i++) {
rdata = *((int16_t *)empty_dma)>>1;
empty_dma += 2;
rdata += *((int16_t *)empty_dma)>>1;
empty_dma += 2;
*((int16_t *)sc->sc_rn) = rdata;
sc->sc_rn += 2;
}
break;
case CF_8BIT_STEREO:
for (i = 0; i < 512; i++) {
rdata = *((int16_t*)empty_dma);
empty_dma += 2;
*sc->sc_rn++ = rdata >> 8;
rdata = *((int16_t*)empty_dma);
empty_dma += 2;
*sc->sc_rn++ = rdata >> 8;
}
break;
case CF_8BIT_MONO:
for (i = 0; i < 512; i++) {
rdata = *((int16_t*)empty_dma) >>1;
empty_dma += 2;
rdata += *((int16_t*)empty_dma) >>1;
empty_dma += 2;
*sc->sc_rn++ = rdata >>8;
}
break;
default:
printf("unknown sc->sc_rparam: %d\n", sc->sc_rparam);
}
if (sc->sc_rn >= sc->sc_re)
sc->sc_rn = sc->sc_rs;
BA1WRITE4(sc, CS4280_CIE, mem);
if (sc->sc_rintr) {
if ((sc->sc_ri%(sc->sc_rcount)) == 0)
sc->sc_rintr(sc->sc_rarg);
} else {
printf("unexpected record intr\n");
}
}
#if NMIDI > 0
if (intr & HISR_MIDI) {
int data;
handled = 1;
DPRINTF(("i: %d: ",
BA0READ4(sc, CS4280_MIDSR)));
while ((sc->sc_iintr != NULL) &&
((BA0READ4(sc, CS4280_MIDSR) & MIDSR_RBE) == 0)) {
data = BA0READ4(sc, CS4280_MIDRP) & MIDRP_MASK;
DPRINTF(("r:%x\n",data));
sc->sc_iintr(sc->sc_arg, data);
}
#if 1
if ((BA0READ4(sc, CS4280_MIDSR) & MIDSR_TBF) == 0) {
DPRINTF(("w: "));
if (sc->sc_ointr != NULL)
sc->sc_ointr(sc->sc_arg);
}
#else
while ((sc->sc_ointr != NULL) &&
((BA0READ4(sc, CS4280_MIDSR) & MIDSR_TBF) == 0)) {
DPRINTF(("w: "));
sc->sc_ointr(sc->sc_arg);
}
#endif
DPRINTF(("\n"));
}
#endif
mtx_leave(&audio_lock);
return handled;
}
int
cs4280_download(struct cs4280_softc *sc, const u_int32_t *src, u_int32_t offset,
u_int32_t len)
{
u_int32_t ctr;
#ifdef CS4280_DEBUG
u_int32_t con, data;
u_int8_t c0,c1,c2,c3;
#endif
if ((offset&3) || (len&3))
return (-1);
len /= sizeof(u_int32_t);
for (ctr = 0; ctr < len; ctr++) {
BA1WRITE4(sc, offset+ctr*4, htole32(*(src+ctr)));
#ifdef CS4280_DEBUG
data = htole32(*(src+ctr));
c0 = bus_space_read_1(sc->ba1t, sc->ba1h, offset+ctr*4+0);
c1 = bus_space_read_1(sc->ba1t, sc->ba1h, offset+ctr*4+1);
c2 = bus_space_read_1(sc->ba1t, sc->ba1h, offset+ctr*4+2);
c3 = bus_space_read_1(sc->ba1t, sc->ba1h, offset+ctr*4+3);
con = ( (c3<<24) | (c2<<16) | (c1<<8) | c0 );
if (data != con ) {
printf("0x%06x: write=0x%08x read=0x%08x\n",
offset+ctr*4, data, con);
return (-1);
}
#endif
}
return (0);
}
struct BA1struct *BA1Struct;
int
cs4280_download_image(struct cs4280_softc *sc)
{
int idx, err = 0;
u_int32_t offset = 0;
static u_char *cs4280_firmware;
static size_t cs4280_firmwarelen;
if (cs4280_firmware == NULL) {
err = loadfirmware("cs4280", &cs4280_firmware,
&cs4280_firmwarelen);
if (err)
return (err);
}
BA1Struct = (struct BA1struct *)cs4280_firmware;
for (idx = 0; idx < BA1_MEMORY_COUNT; ++idx) {
err = cs4280_download(sc, &BA1Struct->map[offset],
BA1Struct->memory[idx].offset, BA1Struct->memory[idx].size);
if (err != 0) {
printf("%s: load_image failed at %d\n",
sc->sc_dev.dv_xname, idx);
return (-1);
}
offset += BA1Struct->memory[idx].size / sizeof(u_int32_t);
}
return (err);
}
#ifdef CS4280_DEBUG
int
cs4280_checkimage(struct cs4280_softc *sc, u_int32_t *src, u_int32_t offset,
u_int32_t len)
{
u_int32_t ctr, data;
int err = 0;
if ((offset&3) || (len&3))
return -1;
len /= sizeof(u_int32_t);
for (ctr = 0; ctr < len; ctr++) {
data = BA1READ4(sc, offset+ctr*4);
if (data != htole32(*(src+ctr))) {
printf("0x%06x: 0x%08x(0x%08x)\n",
offset+ctr*4, data, *(src+ctr));
*(src+ctr) = data;
++err;
}
}
return (err);
}
int
cs4280_check_images(struct cs4280_softc *sc)
{
int idx, err;
u_int32_t offset = 0;
err = 0;
for (idx = 0; idx < 1; ++idx) {
err = cs4280_checkimage(sc, &BA1Struct->map[offset],
BA1Struct->memory[idx].offset,
BA1Struct->memory[idx].size);
if (err != 0) {
printf("%s: check_image failed at %d\n",
sc->sc_dev.dv_xname, idx);
}
offset += BA1Struct->memory[idx].size / sizeof(u_int32_t);
}
return (err);
}
#endif
int
cs4280_attach_codec(void *sc_, struct ac97_codec_if *codec_if)
{
struct cs4280_softc *sc = sc_;
sc->codec_if = codec_if;
return (0);
}
void
cs4280_reset_codec(void *sc_)
{
struct cs4280_softc *sc = sc_;
int n;
BA0WRITE4(sc, CS4280_ACCTL, 0);
delay(100);
BA0WRITE4(sc, CS4280_ACCTL, ACCTL_RSTN);
BA0WRITE4(sc, CS4280_ACCTL, ACCTL_ESYN | ACCTL_RSTN);
delay(50*1000);
BA0WRITE4(sc, CS4280_ACCTL, ACCTL_VFRM | ACCTL_ESYN | ACCTL_RSTN);
n = 0;
while (BA0READ4(sc, CS4280_ACISV) != (ACISV_ISV3 | ACISV_ISV4)) {
delay(1000);
if (++n > 1000) {
printf("reset_codec: AC97 inputs slot ready timeout\n");
return;
}
}
}
void
cs4280_reset(void *sc_)
{
struct cs4280_softc *sc = sc_;
BA1WRITE4(sc, CS4280_SPCR, SPCR_RSTSP);
delay(100);
BA1WRITE4(sc, CS4280_SPCR, 0);
BA1WRITE4(sc, CS4280_SPCR, SPCR_DRQEN);
}
int
cs4280_open(void *addr, int flags)
{
return (0);
}
void
cs4280_close(void *addr)
{
struct cs4280_softc *sc = addr;
cs4280_halt_output(sc);
cs4280_halt_input(sc);
sc->sc_pintr = 0;
sc->sc_rintr = 0;
}
int
cs4280_set_params(void *addr, int setmode, int usemode,
struct audio_params *play, struct audio_params *rec)
{
struct cs4280_softc *sc = addr;
struct audio_params *p;
int mode;
for (mode = AUMODE_RECORD; mode != -1;
mode = mode == AUMODE_RECORD ? AUMODE_PLAY : -1 ) {
if ((setmode & mode) == 0)
continue;
p = mode == AUMODE_PLAY ? play : rec;
if (p == play) {
DPRINTFN(5,("play: sample=%ld precision=%d channels=%d\n",
p->sample_rate, p->precision, p->channels));
} else {
DPRINTFN(5,("rec: sample=%ld precision=%d channels=%d\n",
p->sample_rate, p->precision, p->channels));
}
if (p->sample_rate < 8000)
p->sample_rate = 8000;
if (p->sample_rate > 48000)
p->sample_rate = 48000;
if (p->precision > 16)
p->precision = 16;
if (p->channels > 2)
p->channels = 2;
switch (p->encoding) {
case AUDIO_ENCODING_SLINEAR_LE:
break;
default:
return (EINVAL);
}
p->bps = AUDIO_BPS(p->precision);
p->msb = 1;
}
cs4280_set_dac_rate(sc, play->sample_rate);
cs4280_set_adc_rate(sc, rec->sample_rate);
return (0);
}
int
cs4280_round_blocksize(void *hdl, int blk)
{
return (blk < CS4280_ICHUNK ? CS4280_ICHUNK : blk & -CS4280_ICHUNK);
}
int
cs4280_mixer_get_port(void *addr, mixer_ctrl_t *cp)
{
struct cs4280_softc *sc = addr;
return (sc->codec_if->vtbl->mixer_get_port(sc->codec_if, cp));
}
int
cs4280_query_devinfo(void *addr, mixer_devinfo_t *dip)
{
struct cs4280_softc *sc = addr;
return (sc->codec_if->vtbl->query_devinfo(sc->codec_if, dip));
}
int
cs4280_get_portnum_by_name(struct cs4280_softc *sc, char *class, char *device,
char *qualifier)
{
return (sc->codec_if->vtbl->get_portnum_by_name(sc->codec_if, class,
device, qualifier));
}
int
cs4280_halt_output(void *addr)
{
struct cs4280_softc *sc = addr;
u_int32_t mem;
mtx_enter(&audio_lock);
mem = BA1READ4(sc, CS4280_PCTL);
BA1WRITE4(sc, CS4280_PCTL, mem & ~PCTL_MASK);
#ifdef DIAGNOSTIC
sc->sc_prun = 0;
#endif
mtx_leave(&audio_lock);
return (0);
}
int
cs4280_halt_input(void *addr)
{
struct cs4280_softc *sc = addr;
u_int32_t mem;
mtx_enter(&audio_lock);
mem = BA1READ4(sc, CS4280_CCTL);
BA1WRITE4(sc, CS4280_CCTL, mem & ~CCTL_MASK);
#ifdef DIAGNOSTIC
sc->sc_rrun = 0;
#endif
mtx_leave(&audio_lock);
return (0);
}
int
cs4280_mixer_set_port(void *addr, mixer_ctrl_t *cp)
{
struct cs4280_softc *sc = addr;
int val;
val = sc->codec_if->vtbl->mixer_set_port(sc->codec_if, cp);
DPRINTFN(3,("mixer_set_port: val=%d\n", val));
return (val);
}
int
cs4280_freemem(struct cs4280_softc *sc, struct cs4280_dma *p)
{
bus_dmamap_unload(sc->sc_dmatag, p->map);
bus_dmamap_destroy(sc->sc_dmatag, p->map);
bus_dmamem_unmap(sc->sc_dmatag, p->addr, p->size);
bus_dmamem_free(sc->sc_dmatag, p->segs, p->nsegs);
return (0);
}
int
cs4280_allocmem(struct cs4280_softc *sc, size_t size, size_t align,
struct cs4280_dma *p)
{
int error;
p->size = size;
error = bus_dmamem_alloc(sc->sc_dmatag, p->size, align, 0,
p->segs, sizeof(p->segs)/sizeof(p->segs[0]),
&p->nsegs, BUS_DMA_NOWAIT);
if (error) {
printf("%s: unable to allocate dma, error=%d\n",
sc->sc_dev.dv_xname, error);
return (error);
}
error = bus_dmamem_map(sc->sc_dmatag, p->segs, p->nsegs, p->size,
&p->addr, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
if (error) {
printf("%s: unable to map dma, error=%d\n",
sc->sc_dev.dv_xname, error);
goto free;
}
error = bus_dmamap_create(sc->sc_dmatag, p->size, 1, p->size,
0, BUS_DMA_NOWAIT, &p->map);
if (error) {
printf("%s: unable to create dma map, error=%d\n",
sc->sc_dev.dv_xname, error);
goto unmap;
}
error = bus_dmamap_load(sc->sc_dmatag, p->map, p->addr, p->size, NULL,
BUS_DMA_NOWAIT);
if (error) {
printf("%s: unable to load dma map, error=%d\n",
sc->sc_dev.dv_xname, error);
goto destroy;
}
return (0);
destroy:
bus_dmamap_destroy(sc->sc_dmatag, p->map);
unmap:
bus_dmamem_unmap(sc->sc_dmatag, p->addr, p->size);
free:
bus_dmamem_free(sc->sc_dmatag, p->segs, p->nsegs);
return (error);
}
void *
cs4280_malloc(void *addr, int direction, size_t size, int pool, int flags)
{
struct cs4280_softc *sc = addr;
struct cs4280_dma *p;
caddr_t q;
int error;
DPRINTFN(5,("cs4280_malloc: size=%d pool=%d flags=%d\n", size, pool, flags));
q = malloc(size, pool, flags);
if (!q)
return (0);
p = malloc(sizeof(*p), pool, flags);
if (!p) {
free(q,pool, 0);
return (0);
}
error = cs4280_allocmem(sc, CS4280_DCHUNK, CS4280_DALIGN, p);
if (error) {
free(q, pool, 0);
free(p, pool, 0);
return (0);
}
p->next = sc->sc_dmas;
sc->sc_dmas = p;
p->dum = q;
return (p->dum);
}
void
cs4280_free(void *addr, void *ptr, int pool)
{
struct cs4280_softc *sc = addr;
struct cs4280_dma **pp, *p;
for (pp = &sc->sc_dmas; (p = *pp) != NULL; pp = &p->next) {
if (BUFADDR(p) == ptr) {
cs4280_freemem(sc, p);
*pp = p->next;
free(p->dum, pool, 0);
free(p, pool, 0);
return;
}
}
}
int
cs4280_trigger_output(void *addr, void *start, void *end, int blksize,
void (*intr)(void *), void *arg, struct audio_params *param)
{
struct cs4280_softc *sc = addr;
u_int32_t pfie, pctl, mem, pdtc;
struct cs4280_dma *p;
#ifdef DIAGNOSTIC
if (sc->sc_prun)
printf("cs4280_trigger_output: already running\n");
sc->sc_prun = 1;
#endif
DPRINTF(("cs4280_trigger_output: sc=%p start=%p end=%p "
"blksize=%d intr=%p(%p)\n", addr, start, end, blksize, intr, arg));
sc->sc_pintr = intr;
sc->sc_parg = arg;
mem = BA1READ4(sc, CS4280_PCTL);
BA1WRITE4(sc, CS4280_PCTL, mem & ~PCTL_MASK);
pdtc = BA1READ4(sc, CS4280_PDTC);
pdtc &= ~PDTC_MASK;
pdtc |= CS4280_MK_PDTC(param->precision * param->channels);
BA1WRITE4(sc, CS4280_PDTC, pdtc);
DPRINTF(("param: precision=%d channels=%d encoding=%d\n",
param->precision, param->channels,
param->encoding));
for (p = sc->sc_dmas; p != NULL && BUFADDR(p) != start; p = p->next)
;
if (p == NULL) {
printf("cs4280_trigger_output: bad addr %p\n", start);
return (EINVAL);
}
if (DMAADDR(p) % CS4280_DALIGN != 0 ) {
printf("cs4280_trigger_output: DMAADDR(p)=0x%lx does not start"
"4kB align\n", DMAADDR(p));
return (EINVAL);
}
sc->sc_pcount = blksize / CS4280_ICHUNK;
sc->sc_ps = (char *)start;
sc->sc_pe = (char *)end;
sc->sc_pdma = p;
sc->sc_pbuf = KERNADDR(p);
sc->sc_pi = 0;
sc->sc_pn = sc->sc_ps;
if (blksize >= CS4280_DCHUNK) {
sc->sc_pn = sc->sc_ps + CS4280_DCHUNK;
memcpy(sc->sc_pbuf, start, CS4280_DCHUNK);
++sc->sc_pi;
} else {
sc->sc_pn = sc->sc_ps + CS4280_ICHUNK;
memcpy(sc->sc_pbuf, start, CS4280_ICHUNK);
}
mtx_enter(&audio_lock);
BA1WRITE4(sc, CS4280_PBA, DMAADDR(p));
pfie = BA1READ4(sc, CS4280_PFIE) & ~PFIE_MASK;
if (param->precision == 8)
pfie |= PFIE_8BIT;
if (param->channels == 1)
pfie |= PFIE_MONO;
if (param->encoding == AUDIO_ENCODING_ULINEAR_BE ||
param->encoding == AUDIO_ENCODING_SLINEAR_BE)
pfie |= PFIE_SWAPPED;
if (param->encoding == AUDIO_ENCODING_ULINEAR_BE ||
param->encoding == AUDIO_ENCODING_ULINEAR_LE)
pfie |= PFIE_UNSIGNED;
BA1WRITE4(sc, CS4280_PFIE, pfie | PFIE_PI_ENABLE);
cs4280_set_dac_rate(sc, param->sample_rate);
pctl = BA1READ4(sc, CS4280_PCTL) & ~PCTL_MASK;
pctl |= sc->pctl;
BA1WRITE4(sc, CS4280_PCTL, pctl);
mtx_leave(&audio_lock);
return (0);
}
int
cs4280_trigger_input(void *addr, void *start, void *end, int blksize,
void (*intr)(void *), void *arg, struct audio_params *param)
{
struct cs4280_softc *sc = addr;
u_int32_t cctl, cie;
struct cs4280_dma *p;
#ifdef DIAGNOSTIC
if (sc->sc_rrun)
printf("cs4280_trigger_input: already running\n");
sc->sc_rrun = 1;
#endif
DPRINTF(("cs4280_trigger_input: sc=%p start=%p end=%p "
"blksize=%d intr=%p(%p)\n", addr, start, end, blksize, intr, arg));
sc->sc_rintr = intr;
sc->sc_rarg = arg;
sc->sc_ri = 0;
sc->sc_rcount = blksize / CS4280_ICHUNK;
sc->sc_rs = (char *)start;
sc->sc_re = (char *)end;
sc->sc_rn = sc->sc_rs;
sc->sc_rparam = 0;
if (param->precision == 8) {
sc->sc_rparam += CF_8BIT;
sc->sc_rcount <<= 1;
}
if (param->channels == 1) {
sc->sc_rparam += CF_MONO;
sc->sc_rcount <<= 1;
}
cctl = BA1READ4(sc, CS4280_CCTL) & ~CCTL_MASK;
BA1WRITE4(sc, CS4280_CCTL, cctl);
for (p = sc->sc_dmas; p && BUFADDR(p) != start; p = p->next)
;
if (!p) {
printf("cs4280_trigger_input: bad addr %p\n", start);
return (EINVAL);
}
if (DMAADDR(p) % CS4280_DALIGN != 0) {
printf("cs4280_trigger_input: DMAADDR(p)=0x%lx does not start"
"4kB align\n", DMAADDR(p));
return (EINVAL);
}
sc->sc_rdma = p;
sc->sc_rbuf = KERNADDR(p);
mtx_enter(&audio_lock);
BA1WRITE4(sc, CS4280_CBA, DMAADDR(p));
cie = BA1READ4(sc, CS4280_CIE) & ~CIE_CI_MASK;
BA1WRITE4(sc, CS4280_CIE, cie | CIE_CI_ENABLE);
cs4280_set_adc_rate(sc, param->sample_rate);
cctl = BA1READ4(sc, CS4280_CCTL) & ~CCTL_MASK;
cctl |= sc->cctl;
BA1WRITE4(sc, CS4280_CCTL, cctl);
mtx_leave(&audio_lock);
return (0);
}
int
cs4280_init(struct cs4280_softc *sc, int init)
{
int n;
u_int32_t mem;
BA0WRITE4(sc, CS4280_CLKCR1, 0);
BA0WRITE4(sc, CS4280_SERMC1, 0);
#define SERACC_CODEC_TYPE_1_03
#ifdef SERACC_CODEC_TYPE_1_03
BA0WRITE4(sc, CS4280_SERACC, SERACC_HSP | SERACC_CTYPE_1_03);
#else
BA0WRITE4(sc, CS4280_SERACC, SERACC_HSP | SERACC_CTYPE_2_0);
#endif
BA0WRITE4(sc, CS4280_ACCTL, 0);
delay(100);
BA0WRITE4(sc, CS4280_ACCTL, ACCTL_RSTN);
BA0WRITE4(sc, CS4280_ACCTL, ACCTL_ESYN | ACCTL_RSTN);
delay(50*1000);
BA0WRITE4(sc, CS4280_SERMC1, SERMC1_PTC_AC97);
BA0WRITE4(sc, CS4280_PLLCC, PLLCC_CDR_STATE|PLLCC_LPF_STATE);
BA0WRITE4(sc, CS4280_PLLM, PLLM_STATE);
BA0WRITE4(sc, CS4280_CLKCR2, CLKCR2_PDIVS_8);
BA0WRITE4(sc, CS4280_CLKCR1, CLKCR1_PLLP);
delay(50*1000);
mem = BA0READ4(sc, CS4280_CLKCR1) | CLKCR1_SWCE;
BA0WRITE4(sc, CS4280_CLKCR1, mem);
cs4280_clear_fifos(sc);
#if 0
BA0WRITE4(sc, CS4280_SERBSP, 0);
#endif
BA0WRITE4(sc, CS4280_SERC1, SERC1_SO1EN | SERC1_SO1F_AC97);
BA0WRITE4(sc, CS4280_SERC2, SERC2_SI1EN | SERC2_SI1F_AC97);
BA0WRITE4(sc, CS4280_SERMC1, SERMC1_MSPE | SERMC1_PTC_AC97);
n = 0;
while ((BA0READ4(sc, CS4280_ACSTS) & ACSTS_CRDY) == 0) {
delay(125);
if (++n > 1000) {
printf("%s: codec ready timeout\n",
sc->sc_dev.dv_xname);
return(1);
}
}
BA0WRITE4(sc, CS4280_ACCTL, ACCTL_VFRM | ACCTL_ESYN | ACCTL_RSTN);
n = 0;
while ((BA0READ4(sc, CS4280_ACISV) & (ACISV_ISV3 | ACISV_ISV4)) !=
(ACISV_ISV3 | ACISV_ISV4)) {
delay(1000);
if (++n > 1000) {
printf("AC97 inputs slot ready timeout\n");
return(1);
}
}
BA0WRITE4(sc, CS4280_ACOSV, ACOSV_SLV3 | ACOSV_SLV4);
cs4280_reset(sc);
return (0);
}
int
cs4280_init2(struct cs4280_softc *sc, int init)
{
int n;
u_int32_t mem;
if (cs4280_download_image(sc) != 0) {
printf("%s: image download error\n", sc->sc_dev.dv_xname);
return(1);
}
mem = BA1READ4(sc, CS4280_PCTL);
sc->pctl = mem & PCTL_MASK;
cs4280_halt_output(sc);
mem = BA1READ4(sc, CS4280_CCTL);
sc->cctl = mem & CCTL_MASK;
cs4280_halt_input(sc);
BA1WRITE4(sc, CS4280_FRMT, FRMT_FTV);
BA1WRITE4(sc, CS4280_SPCR, SPCR_RUN | SPCR_RUNFR | SPCR_DRQEN);
n = 0;
while (BA1READ4(sc, CS4280_SPCR) & SPCR_RUNFR) {
delay(10);
if (++n > 1000) {
printf("SPCR 1->0 transition timeout\n");
return(1);
}
}
n = 0;
while (!(BA1READ4(sc, CS4280_SPCS) & SPCS_SPRUN)) {
delay(10);
if (++n > 1000) {
printf("SPCS 0->1 transition timeout\n");
return(1);
}
}
BA1WRITE4(sc, CS4280_PVOL, 0x80008000);
BA1WRITE4(sc, CS4280_CVOL, 0x80008000);
BA0WRITE4(sc, CS4280_HICR, HICR_IEV|HICR_CHGM);
mem = BA1READ4(sc, CS4280_PFIE) & ~PFIE_PI_MASK;
mem |= PFIE_PI_ENABLE;
BA1WRITE4(sc, CS4280_PFIE, mem);
mem = BA1READ4(sc, CS4280_CIE) & ~CIE_CI_MASK;
mem |= CIE_CI_ENABLE;
BA1WRITE4(sc, CS4280_CIE, mem);
#if NMIDI > 0
mem = BA0READ4(sc, CS4280_MIDCR) & ~MIDCR_MASK;
BA0WRITE4(sc, CS4280_MIDCR, mem | MIDCR_MRST);
DPRINTF(("midi reset: 0x%x\n", BA0READ4(sc, CS4280_MIDCR)));
mem |= MIDCR_TXE | MIDCR_RXE | MIDCR_RIE | MIDCR_TIE;
BA0WRITE4(sc, CS4280_MIDCR, mem);
#endif
return(0);
}
int
cs4280_activate(struct device *self, int act)
{
struct cs4280_softc *sc = (struct cs4280_softc *)self;
int rv = 0;
switch (act) {
case DVACT_SUSPEND:
rv = config_activate_children(self, act);
cs4280_write_codec(sc, AC97_REG_POWER, CS4280_POWER_DOWN_ALL);
break;
case DVACT_RESUME:
cs4280_close(sc);
cs4280_init(sc, 0);
cs4280_init2(sc, 0);
ac97_resume(&sc->host_if, sc->codec_if);
rv = config_activate_children(self, act);
break;
default:
rv = config_activate_children(self, act);
break;
}
return (rv);
}
void
cs4280_clear_fifos(struct cs4280_softc *sc)
{
int pd = 0, cnt, n;
u_int32_t mem;
mem = BA0READ4(sc, CS4280_CLKCR1);
if (!(mem & CLKCR1_SWCE)) {
printf("cs4280_clear_fifo: power down found.\n");
BA0WRITE4(sc, CS4280_CLKCR1, mem | CLKCR1_SWCE);
pd = 1;
}
BA0WRITE4(sc, CS4280_SERBWP, 0);
for (cnt = 0; cnt < 256; cnt++) {
n = 0;
while (BA0READ4(sc, CS4280_SERBST) & SERBST_WBSY) {
delay(1000);
if (++n > 1000) {
printf("clear_fifo: fist timeout cnt=%d\n", cnt);
break;
}
}
BA0WRITE4(sc, CS4280_SERBAD, cnt);
BA0WRITE4(sc, CS4280_SERBCM, SERBCM_WRC);
}
if (pd)
BA0WRITE4(sc, CS4280_CLKCR1, mem);
}
#if NMIDI > 0
int
cs4280_midi_open(void *addr, int flags, void (*iintr)(void, int),
void (*ointr)(void *), void *arg)
{
struct cs4280_softc *sc = addr;
u_int32_t mem;
DPRINTF(("midi_open\n"));
sc->sc_iintr = iintr;
sc->sc_ointr = ointr;
sc->sc_arg = arg;
mem = BA0READ4(sc, CS4280_MIDCR) & ~MIDCR_MASK;
mem |= MIDCR_TXE | MIDCR_RXE | MIDCR_RIE | MIDCR_TIE | MIDCR_MLB;
BA0WRITE4(sc, CS4280_MIDCR, mem);
#ifdef CS4280_DEBUG
if (mem != BA0READ4(sc, CS4280_MIDCR)) {
DPRINTF(("midi_open: MIDCR=%d\n", BA0READ4(sc, CS4280_MIDCR)));
return(EINVAL);
}
DPRINTF(("MIDCR=0x%x\n", BA0READ4(sc, CS4280_MIDCR)));
#endif
return (0);
}
void
cs4280_midi_close(void *addr)
{
struct cs4280_softc *sc = addr;
u_int32_t mem;
DPRINTF(("midi_close\n"));
mem = BA0READ4(sc, CS4280_MIDCR);
mem &= ~MIDCR_MASK;
BA0WRITE4(sc, CS4280_MIDCR, mem);
sc->sc_iintr = 0;
sc->sc_ointr = 0;
}
int
cs4280_midi_output(void *addr, int d)
{
struct cs4280_softc *sc = addr;
u_int32_t mem;
int x;
for (x = 0; x != MIDI_BUSY_WAIT; x++) {
if ((BA0READ4(sc, CS4280_MIDSR) & MIDSR_TBF) == 0) {
mem = BA0READ4(sc, CS4280_MIDWP) & ~MIDWP_MASK;
mem |= d & MIDWP_MASK;
DPRINTFN(5,("midi_output d=0x%08x",d));
BA0WRITE4(sc, CS4280_MIDWP, mem);
if (mem != BA0READ4(sc, CS4280_MIDWP)) {
DPRINTF(("Bad write data: %d %d",
mem, BA0READ4(sc, CS4280_MIDWP)));
return(EIO);
}
return (0);
}
delay(MIDI_BUSY_DELAY);
}
return (EIO);
}
void
cs4280_midi_getinfo(void *addr, struct midi_info *mi)
{
mi->name = "CS4280 MIDI UART";
mi->props = MIDI_PROP_CAN_INPUT | MIDI_PROP_OUT_INTR;
}
#endif