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