Aren
/
NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
NetBSD/sys/dev/isa/sf16fmr2.c

358 lines
9.1 KiB
C
Raw Blame History

/* $NetBSD: sf16fmr2.c,v 1.15 2009/05/12 09:10:16 cegger Exp $ */
/* $OpenBSD: sf16fmr2.c,v 1.3 2001/12/18 18:48:08 mickey Exp $ */
/* $RuOBSD: sf16fmr2.c,v 1.12 2001/10/18 16:51:36 pva Exp $ */
/*
* Copyright (c) 2001 Maxim Tsyplakov <tm@oganer.net>,
* Vladimir Popov <jumbo@narod.ru>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
/* SoundForte RadioLink SF16-FMR2 FM Radio Card device driver */
/*
* Philips TEA5757H AM/FM Self Tuned Radio:
* http://www.semiconductors.philips.com/pip/TEA5757H
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: sf16fmr2.c,v 1.15 2009/05/12 09:10:16 cegger Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/proc.h>
#include <sys/errno.h>
#include <sys/ioctl.h>
#include <sys/device.h>
#include <sys/radioio.h>
#include <dev/isa/isavar.h>
#include <dev/radio_if.h>
#include <dev/ic/tea5757.h>
#define SF16FMR2_BASE_VALID(x) (x == 0x384)
#define SF16FMR2_CAPABILITIES RADIO_CAPS_DETECT_STEREO | \
RADIO_CAPS_DETECT_SIGNAL | \
RADIO_CAPS_SET_MONO | \
RADIO_CAPS_LOCK_SENSITIVITY | \
RADIO_CAPS_HW_AFC | \
RADIO_CAPS_HW_SEARCH
#define SF16FMR2_AMPLIFIER (1 << 7)
#define SF16FMR2_SIGNAL (1 << 3)
#define SF16FMR2_STEREO (1 << 3)
#define SF16FMR2_MUTE 0x00
#define SF16FMR2_UNMUTE 0x04
#define SF16FMR2_DATA_ON (1 << 0)
#define SF16FMR2_DATA_OFF (0 << 0)
#define SF16FMR2_CLCK_ON (1 << 1)
#define SF16FMR2_CLCK_OFF (0 << 1)
#define SF16FMR2_WREN_ON (0 << 2) /* SF16-FMR2 has inverse WREN */
#define SF16FMR2_WREN_OFF (1 << 2)
#define SF16FMR2_READ_CLOCK_LOW \
SF16FMR2_DATA_ON | SF16FMR2_CLCK_OFF | SF16FMR2_WREN_OFF
#define SF16FMR2_READ_CLOCK_HIGH \
SF16FMR2_DATA_ON | SF16FMR2_CLCK_ON | SF16FMR2_WREN_OFF
int sf2r_probe(device_t, cfdata_t, void *);
void sf2r_attach(device_t, device_t self, void *);
int sf2r_get_info(void *, struct radio_info *);
int sf2r_set_info(void *, struct radio_info *);
int sf2r_search(void *, int);
/* define our interface to the higher level radio driver */
const struct radio_hw_if sf2r_hw_if = {
NULL, /* open */
NULL, /* close */
sf2r_get_info,
sf2r_set_info,
sf2r_search
};
struct sf2r_softc {
struct device sc_dev;
u_int32_t freq;
u_int32_t stereo;
u_int32_t lock;
u_int8_t vol;
int mute;
struct tea5757_t tea;
};
CFATTACH_DECL(sf2r, sizeof(struct sf2r_softc),
sf2r_probe, sf2r_attach, NULL, NULL);
void sf2r_set_mute(struct sf2r_softc *);
int sf2r_find(bus_space_tag_t, bus_space_handle_t);
u_int32_t sf2r_read_register(bus_space_tag_t, bus_space_handle_t, bus_size_t);
void sf2r_init(bus_space_tag_t, bus_space_handle_t, bus_size_t, u_int32_t);
void sf2r_rset(bus_space_tag_t, bus_space_handle_t, bus_size_t, u_int32_t);
void sf2r_write_bit(bus_space_tag_t, bus_space_handle_t, bus_size_t, int);
int
sf2r_probe(device_t parent, cfdata_t cf, void *aux)
{
struct isa_attach_args *ia = aux;
bus_space_tag_t iot = ia->ia_iot;
bus_space_handle_t ioh;
u_int r;
int iosize = 1, iobase;
if (ISA_DIRECT_CONFIG(ia))
return 0;
if (ia->ia_nio < 1)
return 0;
iobase = ia->ia_io[0].ir_addr;
if (!SF16FMR2_BASE_VALID(iobase)) {
printf("sf2r: configured iobase 0x%x invalid\n", iobase);
return 0;
}
if (bus_space_map(iot, iobase, iosize, 0, &ioh))
return 0;
r = sf2r_find(iot, ioh);
bus_space_unmap(iot, ioh, iosize);
if (r != 0) {
ia->ia_nio = 1;
ia->ia_io[0].ir_size = iosize;
ia->ia_niomem = 0;
ia->ia_nirq = 0;
ia->ia_ndrq = 0;
return (1);
}
return (0);
}
void
sf2r_attach(device_t parent, device_t self, void *aux)
{
struct sf2r_softc *sc = (void *) self;
struct isa_attach_args *ia = aux;
sc->tea.iot = ia->ia_iot;
sc->tea.flags = 0;
sc->mute = 0;
sc->vol = 0;
sc->freq = MIN_FM_FREQ;
sc->stereo = TEA5757_STEREO;
sc->lock = TEA5757_S030;
/* remap I/O */
if (bus_space_map(sc->tea.iot, ia->ia_io[0].ir_addr,
ia->ia_io[0].ir_size, 0, &sc->tea.ioh))
panic("sf2rattach: bus_space_map() failed");
sc->tea.offset = 0;
sc->tea.init = sf2r_init;
sc->tea.rset = sf2r_rset;
sc->tea.write_bit = sf2r_write_bit;
sc->tea.read = sf2r_read_register;
printf(": SoundForte RadioLink SF16-FMR2\n");
tea5757_set_freq(&sc->tea, sc->stereo, sc->lock, sc->freq);
sf2r_set_mute(sc);
radio_attach_mi(&sf2r_hw_if, sc, &sc->sc_dev);
}
/*
* Mute/unmute the card
*/
void
sf2r_set_mute(struct sf2r_softc *sc)
{
u_int8_t mute;
mute = (sc->mute || !sc->vol) ? SF16FMR2_MUTE : SF16FMR2_UNMUTE;
bus_space_write_1(sc->tea.iot, sc->tea.ioh, 0, mute);
DELAY(64);
bus_space_write_1(sc->tea.iot, sc->tea.ioh, 0, mute);
}
void
sf2r_init(bus_space_tag_t iot, bus_space_handle_t ioh, bus_size_t off,
u_int32_t d)
{
bus_space_write_1(iot, ioh, off, SF16FMR2_MUTE);
}
void
sf2r_rset(bus_space_tag_t iot, bus_space_handle_t ioh, bus_size_t off,
u_int32_t d)
{
bus_space_write_1(iot, ioh, off, SF16FMR2_MUTE);
bus_space_write_1(iot, ioh, off, SF16FMR2_UNMUTE);
}
int
sf2r_find(bus_space_tag_t iot, bus_space_handle_t ioh)
{
struct sf2r_softc sc;
u_int32_t freq;
sc.tea.iot = iot;
sc.tea.ioh = ioh;
sc.tea.offset = 0;
sc.tea.init = sf2r_init;
sc.tea.rset = sf2r_rset;
sc.tea.write_bit = sf2r_write_bit;
sc.tea.read = sf2r_read_register;
sc.lock = TEA5757_S030;
sc.stereo = TEA5757_STEREO;
if ((bus_space_read_1(iot, ioh, 0) & 0x70) == 0x30) {
/*
* Let's try to write and read a frequency.
* If the written and read frequencies are
* the same then success.
*/
sc.freq = MIN_FM_FREQ;
tea5757_set_freq(&sc.tea, sc.stereo, sc.lock, sc.freq);
sf2r_set_mute(&sc);
freq = sf2r_read_register(iot, ioh, sc.tea.offset);
if (tea5757_decode_freq(freq, 0) == sc.freq)
return 1;
}
return 0;
}
void
sf2r_write_bit(bus_space_tag_t iot, bus_space_handle_t ioh, bus_size_t off, int bit)
{
u_int8_t data;
data = bit ? SF16FMR2_DATA_ON : SF16FMR2_DATA_OFF;
bus_space_write_1(iot, ioh, off,
SF16FMR2_WREN_ON | SF16FMR2_CLCK_OFF | data);
bus_space_write_1(iot, ioh, off,
SF16FMR2_WREN_ON | SF16FMR2_CLCK_ON | data);
bus_space_write_1(iot, ioh, off,
SF16FMR2_WREN_ON | SF16FMR2_CLCK_OFF | data);
}
u_int32_t
sf2r_read_register(bus_space_tag_t iot, bus_space_handle_t ioh, bus_size_t off)
{
u_int32_t res = 0;
u_int8_t i, state = 0;
bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_LOW);
DELAY(6);
bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_HIGH);
i = bus_space_read_1(iot, ioh, off);
DELAY(6);
/* Amplifier: 0 - not present, 1 - present */
state = i & SF16FMR2_AMPLIFIER ? (1 << 2) : (0 << 2);
/* Signal: 0 - not tuned, 1 - tuned */
state |= i & SF16FMR2_SIGNAL ? (0 << 1) : (1 << 1);
bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_LOW);
i = bus_space_read_1(iot, ioh, off);
/* Stereo: 0 - mono, 1 - stereo */
state |= i & SF16FMR2_STEREO ? (0 << 0) : (1 << 0);
res = i & SF16FMR2_DATA_ON;
i = 23;
while ( i-- ) {
DELAY(6);
res <<= 1;
bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_HIGH);
DELAY(6);
bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_LOW);
res |= bus_space_read_1(iot, ioh, off) & SF16FMR2_DATA_ON;
}
return res | (state << 24);
}
int
sf2r_get_info(void *v, struct radio_info *ri)
{
struct sf2r_softc *sc = v;
u_int32_t buf;
ri->mute = sc->mute;
ri->volume = sc->vol ? 255 : 0;
ri->stereo = sc->stereo == TEA5757_STEREO ? 1 : 0;
ri->caps = SF16FMR2_CAPABILITIES;
ri->rfreq = 0;
ri->lock = tea5757_decode_lock(sc->lock);
buf = sf2r_read_register(sc->tea.iot, sc->tea.ioh, sc->tea.offset);
ri->freq = sc->freq = tea5757_decode_freq(buf, 0);
ri->info = 3 & (buf >> 24);
return (0);
}
int
sf2r_set_info(void *v, struct radio_info *ri)
{
struct sf2r_softc *sc = v;
sc->mute = ri->mute ? 1 : 0;
sc->vol = ri->volume ? 255 : 0;
sc->stereo = ri->stereo ? TEA5757_STEREO: TEA5757_MONO;
sc->lock = tea5757_encode_lock(ri->lock);
ri->freq = sc->freq = tea5757_set_freq(&sc->tea,
sc->lock, sc->stereo, ri->freq);
sf2r_set_mute(sc);
return (0);
}
int
sf2r_search(void *v, int f)
{
struct sf2r_softc *sc = v;
tea5757_search(&sc->tea, sc->lock, sc->stereo, f);
sf2r_set_mute(sc);
return (0);
}
Reference in New Issue View Git Blame Copy Permalink