Annotation of sys/dev/isa/sf16fmr2.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: sf16fmr2.c,v 1.6 2002/10/15 15:00:11 mickey Exp $ */
! 2: /* $RuOBSD: sf16fmr2.c,v 1.12 2001/10/18 16:51:36 pva Exp $ */
! 3:
! 4: /*
! 5: * Copyright (c) 2001 Maxim Tsyplakov <tm@oganer.net>,
! 6: * Vladimir Popov <jumbo@narod.ru>
! 7: * All rights reserved.
! 8: *
! 9: * Redistribution and use in source and binary forms, with or without
! 10: * modification, are permitted provided that the following conditions
! 11: * are met:
! 12: * 1. Redistributions of source code must retain the above copyright
! 13: * notice, this list of conditions and the following disclaimer.
! 14: * 2. Redistributions in binary form must reproduce the above copyright
! 15: * notice, this list of conditions and the following disclaimer in the
! 16: * documentation and/or other materials provided with the distribution.
! 17: *
! 18: * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
! 19: * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
! 20: * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
! 21: * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
! 22: * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
! 23: * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
! 24: * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
! 25: * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
! 26: * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
! 27: * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
! 28: */
! 29:
! 30: /* SoundForte RadioLink SF16-FMR2 FM Radio Card device driver */
! 31:
! 32: /*
! 33: * Philips TEA5757H AM/FM Self Tuned Radio:
! 34: * http://www.semiconductors.philips.com/pip/TEA5757H
! 35: */
! 36:
! 37: #include <sys/param.h>
! 38: #include <sys/systm.h>
! 39: #include <sys/proc.h>
! 40: #include <sys/errno.h>
! 41: #include <sys/ioctl.h>
! 42: #include <sys/device.h>
! 43: #include <sys/radioio.h>
! 44:
! 45: #include <dev/isa/isavar.h>
! 46: #include <dev/radio_if.h>
! 47: #include <dev/ic/tea5757.h>
! 48: #include <dev/ic/pt2254a.h>
! 49:
! 50: #define SF16FMR2_BASE_VALID(x) (x == 0x384)
! 51: #define SF16FMR2_CAPABILITIES RADIO_CAPS_DETECT_STEREO | \
! 52: RADIO_CAPS_DETECT_SIGNAL | \
! 53: RADIO_CAPS_SET_MONO | \
! 54: RADIO_CAPS_LOCK_SENSITIVITY | \
! 55: RADIO_CAPS_HW_AFC | \
! 56: RADIO_CAPS_HW_SEARCH
! 57:
! 58: #define SF16FMR2_AMP 0
! 59: #define SF16FMR2_NOAMP 1
! 60:
! 61: #define SF16FMR2_AMPLIFIER (1 << 7)
! 62: #define SF16FMR2_SIGNAL (1 << 3)
! 63: #define SF16FMR2_STEREO (1 << 3)
! 64:
! 65: #define SF16FMR2_MUTE 0x00
! 66: #define SF16FMR2_UNMUTE 0x04
! 67:
! 68: #define SF16FMR2_DATA_ON (1 << 0)
! 69: #define SF16FMR2_DATA_OFF (0 << 0)
! 70:
! 71: #define SF16FMR2_CLCK_ON (1 << 1)
! 72: #define SF16FMR2_CLCK_OFF (0 << 1)
! 73:
! 74: #define SF16FMR2_WREN_ON (0 << 2) /* SF16-FMR2 has inverse WREN */
! 75: #define SF16FMR2_WREN_OFF (1 << 2)
! 76:
! 77: #define SF16FMR2_READ_CLOCK_LOW \
! 78: SF16FMR2_DATA_ON | SF16FMR2_CLCK_OFF | SF16FMR2_WREN_OFF
! 79:
! 80: #define SF16FMR2_READ_CLOCK_HIGH \
! 81: SF16FMR2_DATA_ON | SF16FMR2_CLCK_ON | SF16FMR2_WREN_OFF
! 82:
! 83: #define SF16FMR2_VOLU_STROBE_ON (0 << 2)
! 84: #define SF16FMR2_VOLU_STROBE_OFF (1 << 2)
! 85: #define SF16FMR2_VOLU_CLOCK_ON (1 << 5)
! 86: #define SF16FMR2_VOLU_CLOCK_OFF (0 << 5)
! 87: #define SF16FMR2_VOLU_DATA_ON (1 << 6)
! 88: #define SF16FMR2_VOLU_DATA_OFF (0 << 6)
! 89:
! 90: int sf2r_probe(struct device *, void *, void *);
! 91: void sf2r_attach(struct device *, struct device * self, void *);
! 92:
! 93: int sf2r_get_info(void *, struct radio_info *);
! 94: int sf2r_set_info(void *, struct radio_info *);
! 95: int sf2r_search(void *, int);
! 96:
! 97: /* define our interface to the higher level radio driver */
! 98: struct radio_hw_if sf2r_hw_if = {
! 99: NULL, /* open */
! 100: NULL, /* close */
! 101: sf2r_get_info,
! 102: sf2r_set_info,
! 103: sf2r_search
! 104: };
! 105:
! 106: struct sf2r_softc {
! 107: struct device sc_dev;
! 108:
! 109: int type;
! 110: u_int32_t freq;
! 111: u_int32_t stereo;
! 112: u_int32_t lock;
! 113: u_int8_t vol;
! 114: int mute;
! 115:
! 116: struct tea5757_t tea;
! 117: };
! 118:
! 119: struct cfattach sf2r_ca = {
! 120: sizeof(struct sf2r_softc), sf2r_probe, sf2r_attach
! 121: };
! 122:
! 123: struct cfdriver sf2r_cd = {
! 124: NULL, "sf2r", DV_DULL
! 125: };
! 126:
! 127: void sf2r_set_mute(struct sf2r_softc *);
! 128: void sf2r_send_vol_bit(bus_space_tag_t, bus_space_handle_t, u_int32_t);
! 129: int sf2r_find(bus_space_tag_t, bus_space_handle_t, int);
! 130:
! 131: u_int32_t sf2r_read_register(bus_space_tag_t, bus_space_handle_t, bus_size_t);
! 132:
! 133: void sf2r_init(bus_space_tag_t, bus_space_handle_t, bus_size_t, u_int32_t);
! 134: void sf2r_rset(bus_space_tag_t, bus_space_handle_t, bus_size_t, u_int32_t);
! 135: void sf2r_write_bit(bus_space_tag_t, bus_space_handle_t, bus_size_t, int);
! 136:
! 137: int
! 138: sf2r_probe(struct device *parent, void *match, void *aux)
! 139: {
! 140: struct isa_attach_args *ia = aux;
! 141: bus_space_tag_t iot = ia->ia_iot;
! 142: bus_space_handle_t ioh;
! 143: struct cfdata *cf = match;
! 144: int iosize = 1, iobase = ia->ia_iobase;
! 145:
! 146: if (!SF16FMR2_BASE_VALID(iobase)) {
! 147: printf("sf2r: configured iobase 0x%x invalid\n", iobase);
! 148: return (0);
! 149: }
! 150:
! 151: if (bus_space_map(iot, iobase, iosize, 0, &ioh))
! 152: return (0);
! 153:
! 154: if (!sf2r_find(iot, ioh, cf->cf_flags)) {
! 155: bus_space_unmap(iot, ioh, iosize);
! 156: return (0);
! 157: }
! 158:
! 159: bus_space_unmap(iot, ioh, iosize);
! 160: ia->ia_iosize = iosize;
! 161: return (1);
! 162: }
! 163:
! 164: void
! 165: sf2r_attach(struct device *parent, struct device *self, void *aux)
! 166: {
! 167: struct sf2r_softc *sc = (void *) self;
! 168: struct isa_attach_args *ia = aux;
! 169: struct cfdata *cf = sc->sc_dev.dv_cfdata;
! 170: int type;
! 171:
! 172: sc->tea.iot = ia->ia_iot;
! 173: sc->mute = 0;
! 174: sc->vol = 0;
! 175: sc->freq = MIN_FM_FREQ;
! 176: sc->stereo = TEA5757_STEREO;
! 177: sc->lock = TEA5757_S030;
! 178:
! 179: /* remap I/O */
! 180: if (bus_space_map(sc->tea.iot, ia->ia_iobase, ia->ia_iosize,
! 181: 0, &sc->tea.ioh)) {
! 182: printf(": bus_space_map() failed\n");
! 183: return;
! 184: }
! 185:
! 186: sc->tea.offset = 0;
! 187: sc->tea.flags = cf->cf_flags;
! 188:
! 189: sc->tea.init = sf2r_init;
! 190: sc->tea.rset = sf2r_rset;
! 191: sc->tea.write_bit = sf2r_write_bit;
! 192: sc->tea.read = sf2r_read_register;
! 193:
! 194: printf(": SoundForte RadioLink SF16-FMR2\n");
! 195: tea5757_set_freq(&sc->tea, sc->stereo, sc->lock, sc->freq);
! 196: sf2r_set_mute(sc);
! 197:
! 198: type = sf2r_read_register(sc->tea.iot, sc->tea.ioh, sc->tea.offset);
! 199: sc->type = (type >> 24) & (1 << 1)? SF16FMR2_AMP : SF16FMR2_NOAMP;
! 200:
! 201: radio_attach_mi(&sf2r_hw_if, sc, &sc->sc_dev);
! 202: }
! 203:
! 204: /*
! 205: * Mute/unmute the card
! 206: */
! 207: void
! 208: sf2r_set_mute(struct sf2r_softc *sc)
! 209: {
! 210: u_int8_t mute;
! 211: u_int32_t reg, vol, i;
! 212:
! 213: if (sc->type == SF16FMR2_NOAMP) {
! 214: mute = (sc->mute || !sc->vol)? SF16FMR2_MUTE : SF16FMR2_UNMUTE;
! 215: bus_space_write_1(sc->tea.iot, sc->tea.ioh, 0, mute);
! 216: DELAY(64);
! 217: bus_space_write_1(sc->tea.iot, sc->tea.ioh, 0, mute);
! 218: } else {
! 219: mute = sc->mute? SF16FMR2_MUTE : SF16FMR2_UNMUTE;
! 220: bus_space_write_1(sc->tea.iot, sc->tea.ioh, 0, mute);
! 221: DELAY(64);
! 222: bus_space_write_1(sc->tea.iot, sc->tea.ioh, 0, mute);
! 223:
! 224: vol = pt2254a_encode_volume(&sc->vol, 255);
! 225: reg = pt2254a_compose_register(vol, vol,
! 226: USE_CHANNEL, USE_CHANNEL);
! 227:
! 228: bus_space_write_1(sc->tea.iot, sc->tea.ioh,
! 229: 0, SF16FMR2_VOLU_STROBE_OFF);
! 230:
! 231: for (i = 0; i < PT2254A_REGISTER_LENGTH; i++)
! 232: sf2r_send_vol_bit(sc->tea.iot, sc->tea.ioh,
! 233: reg & (1 << i));
! 234:
! 235: bus_space_write_1(sc->tea.iot, sc->tea.ioh,
! 236: 0, SF16FMR2_VOLU_STROBE_ON);
! 237: bus_space_write_1(sc->tea.iot, sc->tea.ioh,
! 238: 0, SF16FMR2_VOLU_STROBE_OFF);
! 239: bus_space_write_1(sc->tea.iot, sc->tea.ioh,
! 240: 0, 0x10 | SF16FMR2_VOLU_STROBE_OFF);
! 241: }
! 242: }
! 243:
! 244: void
! 245: sf2r_init(bus_space_tag_t iot, bus_space_handle_t ioh, bus_size_t off, u_int32_t d)
! 246: {
! 247: bus_space_write_1(iot, ioh, off, SF16FMR2_MUTE);
! 248: }
! 249:
! 250: void
! 251: sf2r_rset(bus_space_tag_t iot, bus_space_handle_t ioh, bus_size_t off, u_int32_t d)
! 252: {
! 253: bus_space_write_1(iot, ioh, off, SF16FMR2_MUTE);
! 254: bus_space_write_1(iot, ioh, off, SF16FMR2_UNMUTE);
! 255: }
! 256:
! 257: int
! 258: sf2r_find(bus_space_tag_t iot, bus_space_handle_t ioh, int flags)
! 259: {
! 260: struct sf2r_softc sc;
! 261: u_int32_t freq;
! 262:
! 263: sc.tea.iot = iot;
! 264: sc.tea.ioh = ioh;
! 265: sc.tea.offset = 0;
! 266: sc.tea.flags = flags;
! 267: sc.tea.init = sf2r_init;
! 268: sc.tea.rset = sf2r_rset;
! 269: sc.tea.write_bit = sf2r_write_bit;
! 270: sc.tea.read = sf2r_read_register;
! 271: sc.lock = TEA5757_S030;
! 272: sc.stereo = TEA5757_STEREO;
! 273:
! 274: if ((bus_space_read_1(iot, ioh, 0) & 0x70) == 0x30) {
! 275: /*
! 276: * Let's try to write and read a frequency.
! 277: * If the written and read frequencies are
! 278: * the same then success.
! 279: */
! 280: sc.freq = MIN_FM_FREQ;
! 281: tea5757_set_freq(&sc.tea, sc.stereo, sc.lock, sc.freq);
! 282: sf2r_set_mute(&sc);
! 283: freq = sf2r_read_register(iot, ioh, sc.tea.offset);
! 284: if (tea5757_decode_freq(freq, sc.tea.flags & TEA5757_TEA5759)
! 285: == sc.freq)
! 286: return 1;
! 287: }
! 288:
! 289: return 0;
! 290: }
! 291:
! 292: void
! 293: sf2r_write_bit(bus_space_tag_t iot, bus_space_handle_t ioh, bus_size_t off, int bit)
! 294: {
! 295: u_int8_t data;
! 296:
! 297: data = bit? SF16FMR2_DATA_ON : SF16FMR2_DATA_OFF;
! 298:
! 299: bus_space_write_1(iot, ioh, off,
! 300: SF16FMR2_WREN_ON | SF16FMR2_CLCK_OFF | data);
! 301: bus_space_write_1(iot, ioh, off,
! 302: SF16FMR2_WREN_ON | SF16FMR2_CLCK_ON | data);
! 303: bus_space_write_1(iot, ioh, off,
! 304: SF16FMR2_WREN_ON | SF16FMR2_CLCK_OFF | data);
! 305: }
! 306:
! 307: u_int32_t
! 308: sf2r_read_register(bus_space_tag_t iot, bus_space_handle_t ioh, bus_size_t off)
! 309: {
! 310: u_int32_t res = 0;
! 311: u_int8_t i, state = 0;
! 312:
! 313: bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_LOW);
! 314: DELAY(6);
! 315: bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_HIGH);
! 316:
! 317: i = bus_space_read_1(iot, ioh, off);
! 318: DELAY(6);
! 319: /* Amplifier: 0 - not present, 1 - present */
! 320: state = i & SF16FMR2_AMPLIFIER? (1 << 2) : (0 << 2);
! 321: /* Signal: 0 - not tuned, 1 - tuned */
! 322: state |= i & SF16FMR2_SIGNAL? (0 << 1) : (1 << 1);
! 323:
! 324: bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_LOW);
! 325: i = bus_space_read_1(iot, ioh, off);
! 326: /* Stereo: 0 - mono, 1 - stereo */
! 327: state |= i & SF16FMR2_STEREO? (0 << 0) : (1 << 0);
! 328: res = i & SF16FMR2_DATA_ON;
! 329:
! 330: i = 23;
! 331: while ( i-- ) {
! 332: DELAY(6);
! 333: res <<= 1;
! 334: bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_HIGH);
! 335: DELAY(6);
! 336: bus_space_write_1(iot, ioh, off, SF16FMR2_READ_CLOCK_LOW);
! 337: res |= bus_space_read_1(iot, ioh, off) & SF16FMR2_DATA_ON;
! 338: }
! 339:
! 340: return res | (state << 24);
! 341: }
! 342:
! 343: int
! 344: sf2r_get_info(void *v, struct radio_info *ri)
! 345: {
! 346: struct sf2r_softc *sc = v;
! 347: u_int32_t buf;
! 348:
! 349: ri->mute = sc->mute;
! 350: ri->volume = sc->vol? 255 : 0;
! 351: ri->stereo = sc->stereo == TEA5757_STEREO? 1 : 0;
! 352: ri->caps = SF16FMR2_CAPABILITIES;
! 353: ri->rfreq = 0;
! 354: ri->lock = tea5757_decode_lock(sc->lock);
! 355:
! 356: buf = sf2r_read_register(sc->tea.iot, sc->tea.ioh, sc->tea.offset);
! 357: ri->freq = sc->freq = tea5757_decode_freq(buf,
! 358: sc->tea.flags & TEA5757_TEA5759);
! 359: ri->info = 3 & (buf >> 24);
! 360:
! 361: return (0);
! 362: }
! 363:
! 364: int
! 365: sf2r_set_info(void *v, struct radio_info *ri)
! 366: {
! 367: struct sf2r_softc *sc = v;
! 368:
! 369: sc->mute = ri->mute? 1 : 0;
! 370: sc->vol = ri->volume? 255 : 0;
! 371: sc->stereo = ri->stereo? TEA5757_STEREO: TEA5757_MONO;
! 372: sc->lock = tea5757_encode_lock(ri->lock);
! 373: ri->freq = sc->freq = tea5757_set_freq(&sc->tea,
! 374: sc->lock, sc->stereo, ri->freq);
! 375: sf2r_set_mute(sc);
! 376:
! 377: return (0);
! 378: }
! 379:
! 380: int
! 381: sf2r_search(void *v, int f)
! 382: {
! 383: struct sf2r_softc *sc = v;
! 384:
! 385: tea5757_search(&sc->tea, sc->lock, sc->stereo, f);
! 386: sf2r_set_mute(sc);
! 387:
! 388: return (0);
! 389: }
! 390:
! 391: void
! 392: sf2r_send_vol_bit(bus_space_tag_t iot, bus_space_handle_t ioh, u_int32_t d) {
! 393: u_int8_t data;
! 394:
! 395: data = SF16FMR2_VOLU_STROBE_OFF;
! 396: data |= d? SF16FMR2_VOLU_DATA_ON : SF16FMR2_VOLU_DATA_OFF;
! 397:
! 398: bus_space_write_1(iot, ioh, 0, data | SF16FMR2_VOLU_CLOCK_OFF);
! 399: bus_space_write_1(iot, ioh, 0, data | SF16FMR2_VOLU_CLOCK_ON);
! 400: }
CVSweb
![[BACK]](/icons/back.gif){kind=icon}
Return to sf16fmr2.c CVS log ![[TXT]](/icons/text.gif){kind=icon}
![[DIR]](/icons/dir.gif){kind=icon}
Up to [local] / sys / dev / isa