This source file includes following definitions.
- sf2r_probe
- sf2r_attach
- sf2r_set_mute
- sf2r_init
- sf2r_rset
- sf2r_find
- sf2r_write_bit
- sf2r_read_register
- sf2r_get_info
- sf2r_set_info
- sf2r_search
- sf2r_send_vol_bit
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
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)
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
98 struct radio_hw_if sf2r_hw_if = {
99 NULL,
100 NULL,
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
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
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
277
278
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
320 state = i & SF16FMR2_AMPLIFIER? (1 << 2) : (0 << 2);
321
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
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 }