uda1341.c revision 1.4 1 1.4 thorpej /* $NetBSD: uda1341.c,v 1.4 2002/10/02 05:18:53 thorpej Exp $ */
2 1.1 ichiro
3 1.1 ichiro /*-
4 1.1 ichiro * Copyright (c) 2001 The NetBSD Foundation, Inc. All rights reserved.
5 1.1 ichiro *
6 1.1 ichiro * This code is derived from software contributed to The NetBSD Foundation
7 1.1 ichiro * by Ichiro FUKUHARA (ichiro (at) ichiro.org).
8 1.1 ichiro *
9 1.1 ichiro * Redistribution and use in source and binary forms, with or without
10 1.1 ichiro * modification, are permitted provided that the following conditions
11 1.1 ichiro * are met:
12 1.1 ichiro * 1. Redistributions of source code must retain the above copyright
13 1.1 ichiro * notice, this list of conditions and the following disclaimer.
14 1.1 ichiro * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 ichiro * notice, this list of conditions and the following disclaimer in the
16 1.1 ichiro * documentation and/or other materials provided with the distribution.
17 1.1 ichiro * 3. All advertising materials mentioning features or use of this software
18 1.1 ichiro * must display the following acknowledgement:
19 1.1 ichiro * This product includes software developed by the NetBSD
20 1.1 ichiro * Foundation, Inc. and its contributors.
21 1.1 ichiro * 4. Neither the name of The NetBSD Foundation nor the names of its
22 1.1 ichiro * contributors may be used to endorse or promote products derived
23 1.1 ichiro * from this software without specific prior written permission.
24 1.1 ichiro *
25 1.1 ichiro * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
26 1.1 ichiro * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
27 1.1 ichiro * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
28 1.1 ichiro * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
29 1.1 ichiro * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
30 1.1 ichiro * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
31 1.1 ichiro * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
32 1.1 ichiro * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
33 1.1 ichiro * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
34 1.1 ichiro * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
35 1.1 ichiro * POSSIBILITY OF SUCH DAMAGE.
36 1.1 ichiro */
37 1.1 ichiro
38 1.1 ichiro #include <sys/param.h>
39 1.1 ichiro #include <sys/systm.h>
40 1.1 ichiro #include <sys/types.h>
41 1.1 ichiro #include <sys/conf.h>
42 1.1 ichiro #include <sys/file.h>
43 1.1 ichiro #include <sys/device.h>
44 1.1 ichiro #include <sys/kernel.h>
45 1.1 ichiro #include <sys/kthread.h>
46 1.1 ichiro #include <sys/malloc.h>
47 1.1 ichiro
48 1.1 ichiro #include <machine/bus.h>
49 1.1 ichiro
50 1.1 ichiro #include <hpcarm/dev/ipaq_saipvar.h>
51 1.1 ichiro #include <hpcarm/dev/ipaq_gpioreg.h>
52 1.1 ichiro #include <hpcarm/dev/uda1341.h>
53 1.1 ichiro #include <hpcarm/sa11x0/sa11x0_gpioreg.h>
54 1.1 ichiro #include <hpcarm/sa11x0/sa11x0_sspreg.h>
55 1.1 ichiro
56 1.1 ichiro struct uda1341_softc {
57 1.1 ichiro struct device sc_dev;
58 1.1 ichiro bus_space_tag_t sc_iot;
59 1.1 ichiro bus_space_handle_t sc_ioh;
60 1.1 ichiro struct ipaq_softc *sc_parent;
61 1.1 ichiro };
62 1.1 ichiro
63 1.1 ichiro static int uda1341_match(struct device *, struct cfdata *, void *);
64 1.1 ichiro static void uda1341_attach(struct device *, struct device *, void *);
65 1.1 ichiro static int uda1341_print(void *, const char *);
66 1.1 ichiro static int uda1341_search(struct device *, struct cfdata *, void *);
67 1.1 ichiro
68 1.1 ichiro static void uda1341_output_high(struct uda1341_softc *);
69 1.1 ichiro static void uda1341_output_low(struct uda1341_softc *);
70 1.1 ichiro static void uda1341_L3_init(struct uda1341_softc *);
71 1.1 ichiro static void uda1341_init(struct uda1341_softc *);
72 1.1 ichiro static void uda1341_reset(struct uda1341_softc *);
73 1.1 ichiro static void uda1341_reginit(struct uda1341_softc *);
74 1.1 ichiro
75 1.1 ichiro static int L3_getbit(struct uda1341_softc *);
76 1.1 ichiro static void L3_sendbit(struct uda1341_softc *, int);
77 1.1 ichiro static u_int8_t L3_getbyte(struct uda1341_softc *, int);
78 1.1 ichiro static void L3_sendbyte(struct uda1341_softc *, u_int8_t, int);
79 1.1 ichiro static int L3_read(struct uda1341_softc *, u_int8_t, u_int8_t *, int);
80 1.1 ichiro static int L3_write(struct uda1341_softc *, u_int8_t, u_int8_t *, int);
81 1.1 ichiro
82 1.4 thorpej CFATTACH_DECL(uda, sizeof(struct uda1341_softc),
83 1.4 thorpej uda1341_match, uda1341_attach, NULL, NULL);
84 1.1 ichiro
85 1.1 ichiro /*
86 1.1 ichiro * Philips L3 bus support.
87 1.1 ichiro * GPIO lines are used for clock, data and mode pins.
88 1.1 ichiro */
89 1.1 ichiro #define L3_DATA GPIO_H3600_L3_DATA
90 1.1 ichiro #define L3_MODE GPIO_H3600_L3_MODE
91 1.1 ichiro #define L3_CLK GPIO_H3600_L3_CLK
92 1.1 ichiro
93 1.1 ichiro static struct {
94 1.1 ichiro u_int8_t data0; /* direct addressing register */
95 1.1 ichiro } DIRECT_REG = {0};
96 1.1 ichiro
97 1.1 ichiro static struct {
98 1.1 ichiro u_int8_t data0; /* extended addressing register 1 */
99 1.1 ichiro u_int8_t data1; /* extended addressing register 2 */
100 1.1 ichiro } EXTEND_REG = {0, 0};
101 1.1 ichiro
102 1.1 ichiro /*
103 1.1 ichiro * register space access macros
104 1.1 ichiro */
105 1.1 ichiro #define GPIO_WRITE(sc, reg, val) \
106 1.1 ichiro bus_space_write_4(sc->sc_iot, sc->sc_parent->sc_gpioh, reg, val)
107 1.1 ichiro #define GPIO_READ(sc, reg) \
108 1.1 ichiro bus_space_read_4(sc->sc_iot, sc->sc_parent->sc_gpioh, reg)
109 1.1 ichiro #define EGPIO_WRITE(sc) \
110 1.1 ichiro bus_space_write_2(sc->sc_iot, sc->sc_parent->sc_egpioh, \
111 1.1 ichiro 0, sc->sc_parent->ipaq_egpio)
112 1.1 ichiro #define SSP_WRITE(sc, reg, val) \
113 1.1 ichiro bus_space_write_4(sc->sc_iot, sc->sc_parent->sc_ssph, reg, val)
114 1.1 ichiro
115 1.1 ichiro static int
116 1.1 ichiro uda1341_match(parent, cf, aux)
117 1.1 ichiro struct device *parent;
118 1.1 ichiro struct cfdata *cf;
119 1.1 ichiro void *aux;
120 1.1 ichiro {
121 1.1 ichiro return (1);
122 1.1 ichiro }
123 1.1 ichiro
124 1.1 ichiro static void
125 1.1 ichiro uda1341_attach(parent, self, aux)
126 1.1 ichiro struct device *parent;
127 1.1 ichiro struct device *self;
128 1.1 ichiro void *aux;
129 1.1 ichiro {
130 1.1 ichiro struct uda1341_softc *sc = (struct uda1341_softc *)self;
131 1.1 ichiro struct ipaq_softc *psc = (struct ipaq_softc *)parent;
132 1.1 ichiro
133 1.1 ichiro printf("\n");
134 1.1 ichiro printf("%s: UDA1341 CODEC\n", sc->sc_dev.dv_xname);
135 1.1 ichiro
136 1.1 ichiro sc->sc_iot = psc->sc_iot;
137 1.1 ichiro sc->sc_ioh = psc->sc_ioh;
138 1.1 ichiro sc->sc_parent = (struct ipaq_softc *)parent;
139 1.1 ichiro
140 1.1 ichiro uda1341_L3_init(sc);
141 1.1 ichiro uda1341_init(sc);
142 1.1 ichiro
143 1.1 ichiro uda1341_reset(sc);
144 1.1 ichiro
145 1.1 ichiro uda1341_reginit(sc);
146 1.1 ichiro
147 1.1 ichiro
148 1.1 ichiro /*
149 1.1 ichiro * Attach each devices
150 1.1 ichiro */
151 1.1 ichiro
152 1.1 ichiro config_search(uda1341_search, self, NULL);
153 1.1 ichiro }
154 1.1 ichiro
155 1.1 ichiro static int
156 1.1 ichiro uda1341_search(parent, cf, aux)
157 1.1 ichiro struct device *parent;
158 1.1 ichiro struct cfdata *cf;
159 1.1 ichiro void *aux;
160 1.1 ichiro {
161 1.2 thorpej if (config_match(parent, cf, NULL) > 0)
162 1.1 ichiro config_attach(parent, cf, NULL, uda1341_print);
163 1.1 ichiro return 0;
164 1.1 ichiro }
165 1.1 ichiro
166 1.1 ichiro
167 1.1 ichiro static int
168 1.1 ichiro uda1341_print(aux, name)
169 1.1 ichiro void *aux;
170 1.1 ichiro const char *name;
171 1.1 ichiro {
172 1.1 ichiro return (UNCONF);
173 1.1 ichiro }
174 1.1 ichiro
175 1.1 ichiro static void
176 1.1 ichiro uda1341_output_high(sc)
177 1.1 ichiro struct uda1341_softc *sc;
178 1.1 ichiro {
179 1.1 ichiro int cr;
180 1.1 ichiro
181 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, (L3_DATA | L3_MODE | L3_CLK));
182 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR) | (L3_DATA | L3_MODE | L3_CLK);
183 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
184 1.1 ichiro }
185 1.1 ichiro
186 1.1 ichiro static void
187 1.1 ichiro uda1341_output_low(sc)
188 1.1 ichiro struct uda1341_softc *sc;
189 1.1 ichiro {
190 1.1 ichiro int cr;
191 1.1 ichiro
192 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR);
193 1.1 ichiro cr &= ~(L3_DATA | L3_MODE | L3_CLK);
194 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
195 1.1 ichiro }
196 1.1 ichiro
197 1.1 ichiro static void
198 1.1 ichiro uda1341_L3_init(sc)
199 1.1 ichiro struct uda1341_softc *sc;
200 1.1 ichiro {
201 1.1 ichiro int cr;
202 1.1 ichiro
203 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_AFR);
204 1.1 ichiro cr &= ~(L3_DATA | L3_MODE | L3_CLK);
205 1.1 ichiro GPIO_WRITE(sc, SAGPIO_AFR, cr);
206 1.1 ichiro
207 1.1 ichiro uda1341_output_low(sc);
208 1.1 ichiro }
209 1.1 ichiro
210 1.1 ichiro static void
211 1.1 ichiro uda1341_init(sc)
212 1.1 ichiro struct uda1341_softc *sc;
213 1.1 ichiro {
214 1.1 ichiro int cr;
215 1.1 ichiro
216 1.1 ichiro /* GPIO initialize */
217 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_AFR);
218 1.1 ichiro cr &= ~(GPIO_ALT_SSP_TXD | GPIO_ALT_SSP_RXD | GPIO_ALT_SSP_SCLK |
219 1.1 ichiro GPIO_ALT_SSP_SFRM);
220 1.1 ichiro cr |= GPIO_ALT_SSP_CLK;
221 1.1 ichiro GPIO_WRITE(sc, SAGPIO_AFR, cr);
222 1.1 ichiro
223 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR);
224 1.1 ichiro cr &= ~GPIO_ALT_SSP_CLK;
225 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
226 1.1 ichiro
227 1.1 ichiro /* SSP initialize & enable */
228 1.1 ichiro SSP_WRITE(sc, SASSP_CR1, CR1_ECS);
229 1.1 ichiro cr = 0xF | (CR0_FRF_MASK & (1<<4)) | (CR0_SCR_MASK & (3<<8)) | CR0_SSE;
230 1.1 ichiro SSP_WRITE(sc, SASSP_CR0, cr);
231 1.1 ichiro
232 1.1 ichiro /* Enable the audio power */
233 1.1 ichiro sc->sc_parent->ipaq_egpio |=
234 1.1 ichiro (EGPIO_H3600_AUD_PWRON | EGPIO_H3600_AUD_ON);
235 1.1 ichiro sc->sc_parent->ipaq_egpio &=
236 1.1 ichiro ~(EGPIO_H3600_CODEC_RESET | EGPIO_H3600_QMUTE);
237 1.1 ichiro EGPIO_WRITE(sc);
238 1.1 ichiro
239 1.1 ichiro /* external clock configured for 44100 samples/sec */
240 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR);
241 1.1 ichiro cr |= (GPIO_H3600_CLK_SET0 | GPIO_H3600_CLK_SET1);
242 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
243 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, GPIO_H3600_CLK_SET0);
244 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, GPIO_H3600_CLK_SET1);
245 1.1 ichiro
246 1.1 ichiro /* wait for power on */
247 1.1 ichiro delay(100*1000);
248 1.1 ichiro sc->sc_parent->ipaq_egpio |= EGPIO_H3600_CODEC_RESET;
249 1.1 ichiro EGPIO_WRITE(sc);
250 1.1 ichiro
251 1.1 ichiro /* Wait for the UDA1341 to wake up */
252 1.1 ichiro delay(100*1000);
253 1.1 ichiro }
254 1.1 ichiro
255 1.1 ichiro static void
256 1.1 ichiro uda1341_reset(sc)
257 1.1 ichiro struct uda1341_softc *sc;
258 1.1 ichiro {
259 1.1 ichiro u_int8_t command;
260 1.1 ichiro
261 1.1 ichiro command = (L3_ADDRESS_COM << 2) | L3_ADDRESS_STATUS;
262 1.1 ichiro DIRECT_REG.data0 = STATUS0_RST | STATUS0_SC_256 | STATUS0_IF_LSB16;
263 1.1 ichiro L3_write(sc, command, (u_int8_t *) &DIRECT_REG, 1);
264 1.1 ichiro
265 1.1 ichiro sc->sc_parent->ipaq_egpio &= ~EGPIO_H3600_CODEC_RESET;
266 1.1 ichiro EGPIO_WRITE(sc);
267 1.1 ichiro sc->sc_parent->ipaq_egpio |= EGPIO_H3600_CODEC_RESET;
268 1.1 ichiro EGPIO_WRITE(sc);
269 1.1 ichiro
270 1.1 ichiro DIRECT_REG.data0 &= ~STATUS0_RST;
271 1.1 ichiro L3_write(sc, command, (u_int8_t *) &DIRECT_REG, 1);
272 1.1 ichiro }
273 1.1 ichiro
274 1.1 ichiro static void
275 1.1 ichiro uda1341_reginit(sc)
276 1.1 ichiro struct uda1341_softc *sc;
277 1.1 ichiro {
278 1.1 ichiro u_int8_t command;
279 1.1 ichiro
280 1.1 ichiro /* STATUS 0 */
281 1.1 ichiro command = (L3_ADDRESS_COM << 2) | L3_ADDRESS_STATUS;
282 1.1 ichiro DIRECT_REG.data0 = STATUS0_SC_256 | STATUS0_IF_LSB16;
283 1.1 ichiro L3_write(sc, command, (u_int8_t *) &DIRECT_REG, 1);
284 1.1 ichiro
285 1.1 ichiro /* STATUS 1 */
286 1.1 ichiro DIRECT_REG.data0 = STATUS1_OGS | STATUS1_IGS | (1<<7);
287 1.1 ichiro L3_write(sc, command, (u_int8_t *) &DIRECT_REG, 1);
288 1.1 ichiro
289 1.1 ichiro /* DATA 0 */
290 1.1 ichiro command = (L3_ADDRESS_COM << 2) | L3_ADDRESS_DATA0;
291 1.1 ichiro DIRECT_REG.data0 = DATA0_VC(100) | DATA0_COMMON;
292 1.1 ichiro L3_write(sc, command, (u_int8_t *) &DIRECT_REG, 1);
293 1.1 ichiro
294 1.1 ichiro /* DATA 1 */
295 1.1 ichiro DIRECT_REG.data0 = DATA1_BB(0) | DATA1_TR(0) | DATA1_COMMON;
296 1.1 ichiro L3_write(sc, command, (u_int8_t *) &DIRECT_REG, 1);
297 1.1 ichiro
298 1.1 ichiro /* DATA 2*/
299 1.1 ichiro DIRECT_REG.data0 = DATA2_PP | DATA2_COMMON;
300 1.1 ichiro L3_write(sc, command, (u_int8_t *) &DIRECT_REG, 1);
301 1.1 ichiro
302 1.1 ichiro /* Extended DATA 0 */
303 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E0;
304 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | 0x4 ;
305 1.1 ichiro L3_write(sc, command, (u_int8_t *) &EXTEND_REG, 2);
306 1.1 ichiro
307 1.1 ichiro /* Extended DATA 1 */
308 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E1;
309 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | 0x4 ;
310 1.1 ichiro L3_write(sc, command, (u_int8_t *) &EXTEND_REG, 2);
311 1.1 ichiro
312 1.1 ichiro /* Extended DATA 2 */
313 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E2;
314 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | DATA_E2_MS(30);
315 1.1 ichiro L3_write(sc, command, (u_int8_t *) &EXTEND_REG, 2);
316 1.1 ichiro
317 1.1 ichiro /* Extended DATA 3 */
318 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E3;
319 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | DATA_E3_IG_L(0);
320 1.1 ichiro L3_write(sc, command, (u_int8_t *) &EXTEND_REG, 2);
321 1.1 ichiro
322 1.1 ichiro /* Extended DATA 4 */
323 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E4;
324 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | DATA_E4_IG_H(0);
325 1.1 ichiro L3_write(sc, command, (u_int8_t *) &EXTEND_REG, 2);
326 1.1 ichiro
327 1.1 ichiro /* Extended DATA 5 */
328 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E5;
329 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN;
330 1.1 ichiro L3_write(sc, command, (u_int8_t *) &EXTEND_REG, 2);
331 1.1 ichiro }
332 1.1 ichiro
333 1.1 ichiro static int
334 1.1 ichiro L3_getbit(sc)
335 1.1 ichiro struct uda1341_softc *sc;
336 1.1 ichiro {
337 1.1 ichiro int cr, data;
338 1.1 ichiro
339 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
340 1.1 ichiro delay(L3_CLK_LOW);
341 1.1 ichiro
342 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PLR);
343 1.1 ichiro data = (cr & L3_DATA) ? 1 : 0;
344 1.1 ichiro
345 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
346 1.1 ichiro delay(L3_CLK_HIGH);
347 1.1 ichiro
348 1.1 ichiro return (data);
349 1.1 ichiro }
350 1.1 ichiro
351 1.1 ichiro static void
352 1.1 ichiro L3_sendbit(sc, bit)
353 1.1 ichiro struct uda1341_softc *sc;
354 1.1 ichiro int bit;
355 1.1 ichiro {
356 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
357 1.1 ichiro
358 1.1 ichiro if (bit & 0x01)
359 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_DATA);
360 1.1 ichiro else
361 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_DATA);
362 1.1 ichiro
363 1.1 ichiro delay(L3_CLK_LOW);
364 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
365 1.1 ichiro delay(L3_CLK_HIGH);
366 1.1 ichiro }
367 1.1 ichiro
368 1.1 ichiro static u_int8_t
369 1.1 ichiro L3_getbyte(sc, mode)
370 1.1 ichiro struct uda1341_softc *sc;
371 1.1 ichiro int mode;
372 1.1 ichiro {
373 1.1 ichiro int i;
374 1.1 ichiro u_int8_t data;
375 1.1 ichiro
376 1.1 ichiro switch (mode) {
377 1.1 ichiro case 0: /* Address mode */
378 1.1 ichiro case 1: /* First data byte */
379 1.1 ichiro break;
380 1.1 ichiro default: /* second data byte via halt-Time */
381 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
382 1.1 ichiro delay(L3_HALT);
383 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
384 1.1 ichiro break;
385 1.1 ichiro }
386 1.1 ichiro
387 1.1 ichiro delay(L3_MODE_SETUP);
388 1.1 ichiro
389 1.1 ichiro for (i = 0; i < 8; i++)
390 1.1 ichiro data |= (L3_getbit(sc) << i);
391 1.1 ichiro
392 1.1 ichiro delay(L3_MODE_HOLD);
393 1.1 ichiro
394 1.1 ichiro return (data);
395 1.1 ichiro }
396 1.1 ichiro
397 1.1 ichiro static void
398 1.1 ichiro L3_sendbyte(sc, data, mode)
399 1.1 ichiro struct uda1341_softc *sc;
400 1.1 ichiro u_int8_t data;
401 1.1 ichiro int mode;
402 1.1 ichiro {
403 1.1 ichiro int i;
404 1.1 ichiro
405 1.1 ichiro switch (mode) {
406 1.1 ichiro case 0: /* Address mode */
407 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
408 1.1 ichiro break;
409 1.1 ichiro case 1: /* First data byte */
410 1.1 ichiro break;
411 1.1 ichiro default: /* second data byte via halt-Time */
412 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
413 1.1 ichiro delay(L3_HALT);
414 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
415 1.1 ichiro break;
416 1.1 ichiro }
417 1.1 ichiro
418 1.1 ichiro delay(L3_MODE_SETUP);
419 1.1 ichiro
420 1.1 ichiro for (i = 0; i < 8; i++)
421 1.1 ichiro L3_sendbit(sc, data >> i);
422 1.1 ichiro
423 1.1 ichiro if (mode == 0) /* Address mode */
424 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
425 1.1 ichiro
426 1.1 ichiro delay(L3_MODE_HOLD);
427 1.1 ichiro }
428 1.1 ichiro
429 1.1 ichiro static int
430 1.1 ichiro L3_read(sc, addr, data, len)
431 1.1 ichiro struct uda1341_softc *sc;
432 1.1 ichiro u_int8_t addr, *data;
433 1.1 ichiro int len;
434 1.1 ichiro {
435 1.1 ichiro int cr, mode;
436 1.1 ichiro mode = 0;
437 1.1 ichiro
438 1.1 ichiro uda1341_output_high(sc);
439 1.1 ichiro L3_sendbyte(sc, addr, mode++);
440 1.1 ichiro
441 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR);
442 1.1 ichiro cr &= ~(L3_DATA);
443 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
444 1.1 ichiro
445 1.1 ichiro while(len--)
446 1.1 ichiro *data++ = L3_getbyte(sc, mode++);
447 1.1 ichiro uda1341_output_low(sc);
448 1.1 ichiro
449 1.1 ichiro return len;
450 1.1 ichiro }
451 1.1 ichiro
452 1.1 ichiro static int
453 1.1 ichiro L3_write(sc, addr, data, len)
454 1.1 ichiro struct uda1341_softc *sc;
455 1.1 ichiro u_int8_t addr, *data;
456 1.1 ichiro int len;
457 1.1 ichiro {
458 1.1 ichiro int mode = 0;
459 1.1 ichiro
460 1.1 ichiro uda1341_output_high(sc);
461 1.1 ichiro L3_sendbyte(sc, addr, mode++);
462 1.1 ichiro while(len--)
463 1.1 ichiro L3_sendbyte(sc, *data++, mode++);
464 1.1 ichiro uda1341_output_low(sc);
465 1.1 ichiro
466 1.1 ichiro return len;
467 1.1 ichiro }
468