root/dev/isa/sf16fmr.c

DEFINITIONS

1. sfr_probe
2. sfr_attach
3. sfr_find
4. sfr_get_info
5. sfr_set_info
6. sfr_set_freq
7. sfr_get_freq
8. sfr_set_vol
9. sfr_send_volume

    1 /*      $OpenBSD: sf16fmr.c,v 1.1 2002/04/25 04:56:59 mickey Exp $      */
    3 /*
    4  * Copyright (c) 2002 Vladimir Popov <jumbo@narod.ru>
    5  * All rights reserved.
    6  *
    7  * Redistribution and use in source and binary forms, with or without
    8  * modification, are permitted provided that the following conditions
    9  * are met:
   10  * 1. Redistributions of source code must retain the above copyright
   11  *    notice, this list of conditions and the following disclaimer.
   12  * 2. Redistributions in binary form must reproduce the above copyright
   13  *    notice, this list of conditions and the following disclaimer in the
   14  *    documentation and/or other materials provided with the distribution.
   15  *
   16  * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
   17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
   18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
   19  * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
   20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
   21  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
   22  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
   23  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
   24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
   25  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
   26  */
   28 /* SoundForte RadioLink SF16-FMR FM Radio Card device driver */
   30 #include <sys/param.h>
   31 #include <sys/systm.h>
   32 #include <sys/proc.h>
   33 #include <sys/errno.h>
   34 #include <sys/ioctl.h>
   35 #include <sys/device.h>
   36 #include <sys/radioio.h>
   38 #include <dev/isa/isavar.h>
   39 #include <dev/radio_if.h>
   41 #include <dev/ic/tc921x.h>
   42 #include <dev/ic/pt2254a.h>
   44 #define SF16FMR_BASE_VALID(x)   (x == 0x384 || x == 0x284)
   46 #define SF16FMR_CAPABILITIES    0
   48 #define SF16FMR_FREQ_DATA       0
   49 #define SF16FMR_FREQ_CLOCK      1
   50 #define SF16FMR_FREQ_PERIOD     2
   52 #define SF16FMR_FREQ_STEADY     (1 << SF16FMR_FREQ_DATA) | \
   53                                 (1 << SF16FMR_FREQ_CLOCK) | \
   54                                 (1 << SF16FMR_FREQ_PERIOD)
   56 #define SF16FMR_VOLU_STROBE_ON  (1 << 3)
   57 #define SF16FMR_VOLU_STROBE_OFF (0 << 3)
   58 #define SF16FMR_VOLU_CLOCK_ON   (1 << 4)
   59 #define SF16FMR_VOLU_CLOCK_OFF  (0 << 4)
   60 #define SF16FMR_VOLU_DATA_ON    (1 << 5)
   61 #define SF16FMR_VOLU_DATA_OFF   (0 << 5)
   63 int     sfr_probe(struct device *, void *, void *);
   64 void    sfr_attach(struct device *, struct device * self, void *);
   66 int     sfr_get_info(void *, struct radio_info *);
   67 int     sfr_set_info(void *, struct radio_info *);
   69 /* define our interface to the higher level radio driver */
   70 struct radio_hw_if sfr_hw_if = {
NULL, /* open */
NULL, /* close */
sfr_get_info,
sfr_set_info,
NULL
   76 };
   78 struct sfr_softc {
   79         struct device   sc_dev;
u_int32_t       freq;
u_int8_t        vol;
   83         int     mute;
   85         struct tc921x_t c;
   86 };
   88 struct cfattach sfr_ca = {
   89         sizeof(struct sfr_softc), sfr_probe, sfr_attach
   90 };
   92 struct cfdriver sfr_cd = {
NULL, "sfr", DV_DULL
   94 };
   96 int     sfr_find(bus_space_tag_t, bus_space_handle_t);
u_int32_t       sfr_set_freq(struct tc921x_t *, u_int32_t);
u_int32_t       sfr_get_freq(struct tc921x_t *);
u_int8_t        sfr_set_vol(bus_space_tag_t, bus_space_handle_t, u_int8_t, int);
  100 void    sfr_send_volume(bus_space_tag_t, bus_space_handle_t, u_int32_t);
  102 int
sfr_probe(struct device *parent, void *match, void *aux)
  104 {
  105         struct isa_attach_args *ia = aux;
bus_space_tag_t iot = ia->ia_iot;
bus_space_handle_t ioh;
  108         int iosize = 1, iobase = ia->ia_iobase;
  110         if (!SF16FMR_BASE_VALID(iobase)) {
printf("sfr: configured iobase 0x%x invalid\n", iobase);
  112                 return (0);
  113         }
  115         if (bus_space_map(iot, iobase, iosize, 0, &ioh))
  116                 return (0);
  118         if (!sfr_find(iot, ioh)) {
bus_space_unmap(iot, ioh, iosize);
  120                 return (0);
  121         }
bus_space_unmap(iot, ioh, iosize);
ia->ia_iosize = iosize;
  125         return (1);
  126 }
  128 void
sfr_attach(struct device *parent, struct device *self, void *aux)
  130 {
  131         struct sfr_softc *sc = (void *) self;
  132         struct isa_attach_args *ia = aux;
sc->c.iot = ia->ia_iot;
sc->mute = 0;
sc->vol = 0;
sc->freq = MIN_FM_FREQ;
sc->c.period = SF16FMR_FREQ_PERIOD;
sc->c.clock = SF16FMR_FREQ_CLOCK;
sc->c.data = SF16FMR_FREQ_DATA;
  142         /* remap I/O */
  143         if (bus_space_map(sc->c.iot, ia->ia_iobase, ia->ia_iosize,
  144                           0, &sc->c.ioh)) {
printf(": bus_space_map() failed\n");
  146                 return;
  147         }
printf(": SoundForte RadioLink SF16-FMR\n");
sfr_set_freq(&sc->c, sc->freq);
sfr_set_vol(sc->c.iot, sc->c.ioh, sc->vol, sc->mute);
radio_attach_mi(&sfr_hw_if, sc, &sc->sc_dev);
  154 }
  156 int
sfr_find(bus_space_tag_t iot, bus_space_handle_t ioh)
  158 {
  159         struct sfr_softc sc;
u_int32_t freq;
sc.c.iot = iot;
sc.c.ioh = ioh;
sc.c.offset = 0;
sc.c.period = SF16FMR_FREQ_PERIOD;
sc.c.clock = SF16FMR_FREQ_CLOCK;
sc.c.data = SF16FMR_FREQ_DATA;
  169         /*
  170          * Let's try to write and read a frequency.
  171          * If the written and read frequencies are
  172          * the same then success.
  173          */
sc.freq = MIN_FM_FREQ;
  175         /* Initialize the tc921x chip */
sfr_set_freq(&sc.c, sc.freq);
  177         /* Do actual frequency setting */
freq = sfr_set_freq(&sc.c, sc.freq);
  179         if (sc.freq == freq)
  180                 return 1;
  182         return 0;
  183 }
  185 int
sfr_get_info(void *v, struct radio_info *ri)
  187 {
  188         struct sfr_softc *sc = v;
ri->mute = sc->mute;
ri->volume = sc->vol;
ri->caps = SF16FMR_CAPABILITIES;
ri->freq  = sc->freq = sfr_get_freq(&sc->c);
  195         /* Not supported */
ri->stereo = 1; /* Always stereo */
ri->rfreq = 0;
ri->lock = 0;
  200         return (0);
  201 }
  203 int
sfr_set_info(void *v, struct radio_info *ri)
  205 {
  206         struct sfr_softc *sc = v;
sc->mute = ri->mute ? 1 : 0;
sc->vol = ri->volume;
sc->freq = sfr_set_freq(&sc->c, ri->freq);
sc->vol = sfr_set_vol(sc->c.iot, sc->c.ioh, sc->vol, sc->mute);
  213         return (0);
  214 }
u_int32_t
sfr_set_freq(struct tc921x_t *c, u_int32_t freq) {
u_int32_t data = 0ul;
data |= tc921x_encode_freq(freq);
data |= TC921X_D0_REF_FREQ_10_KHZ;
data |= TC921X_D0_PULSE_SWALLOW_FM_MODE;
data |= TC921X_D0_OSC_7POINT2_MHZ;
data |= TC921X_D0_OUT_CONTROL_ON;
tc921x_write_addr(c, 0xD0, data);
data  = TC921X_D2_IO_PORT_OUTPUT(4);
tc921x_write_addr(c, 0xD2, data);
  230         return sfr_get_freq(c);
  231 }
u_int32_t
sfr_get_freq(struct tc921x_t *c) {
  235         return tc921x_decode_freq(tc921x_read_addr(c, 0xD1));
  236 }
u_int8_t
sfr_set_vol(bus_space_tag_t iot, bus_space_handle_t ioh, u_int8_t vol, int mute) {
u_int32_t v;
u_int8_t ret;
ret = mute ? 0 : vol;
v = pt2254a_encode_volume(&ret, 255);
sfr_send_volume(iot, ioh,
pt2254a_compose_register(v, v, USE_CHANNEL, USE_CHANNEL));
  250         return ret;
  251 }
  253 void
sfr_send_volume(bus_space_tag_t iot, bus_space_handle_t ioh, u_int32_t vol) {
u_int8_t one, zero;
  256         int i;
one = zero  = SF16FMR_FREQ_STEADY;
one = zero |= SF16FMR_VOLU_STROBE_OFF;
one  |= SF16FMR_VOLU_DATA_ON;
zero |= SF16FMR_VOLU_DATA_OFF;
bus_space_write_1(iot, ioh, 0, SF16FMR_VOLU_STROBE_OFF | SF16FMR_FREQ_STEADY);
  266         for (i = 0; i < PT2254A_REGISTER_LENGTH; i++) {
  267                 if (vol & (1 << i)) {
bus_space_write_1(iot, ioh, 0,
one  | SF16FMR_VOLU_CLOCK_OFF);
bus_space_write_1(iot, ioh, 0,
one  | SF16FMR_VOLU_CLOCK_ON);
  272                 } else {
bus_space_write_1(iot, ioh, 0,
zero | SF16FMR_VOLU_CLOCK_OFF);
bus_space_write_1(iot, ioh, 0,
zero | SF16FMR_VOLU_CLOCK_ON);
  277                 }
  278         }
  280         /* Latch the data */
bus_space_write_1(iot, ioh, 0, SF16FMR_VOLU_STROBE_ON | SF16FMR_FREQ_STEADY);
bus_space_write_1(iot, ioh, 0, SF16FMR_VOLU_STROBE_OFF | SF16FMR_FREQ_STEADY);
  283 }