uda1341.c revision 1.14 1 1.14 rjs /* $NetBSD: uda1341.c,v 1.14 2009/05/29 14:15:45 rjs 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.14 rjs __KERNEL_RCSID(0, "$NetBSD: uda1341.c,v 1.14 2009/05/29 14:15:45 rjs 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.14 rjs device_t 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.14 rjs static int uda1341_match(device_t, cfdata_t, void *);
61 1.14 rjs static void uda1341_attach(device_t, device_t, void *);
62 1.1 ichiro static int uda1341_print(void *, const char *);
63 1.14 rjs static int uda1341_search(device_t, cfdata_t, const int *, void *);
64 1.1 ichiro
65 1.1 ichiro static void uda1341_output_high(struct uda1341_softc *);
66 1.1 ichiro static void uda1341_output_low(struct uda1341_softc *);
67 1.1 ichiro static void uda1341_L3_init(struct uda1341_softc *);
68 1.1 ichiro static void uda1341_init(struct uda1341_softc *);
69 1.1 ichiro static void uda1341_reset(struct uda1341_softc *);
70 1.1 ichiro static void uda1341_reginit(struct uda1341_softc *);
71 1.1 ichiro
72 1.14 rjs #if 0
73 1.1 ichiro static int L3_getbit(struct uda1341_softc *);
74 1.14 rjs #endif
75 1.1 ichiro static void L3_sendbit(struct uda1341_softc *, int);
76 1.14 rjs #if 0
77 1.9 peter static uint8_t L3_getbyte(struct uda1341_softc *, int);
78 1.14 rjs #endif
79 1.9 peter static void L3_sendbyte(struct uda1341_softc *, uint8_t, int);
80 1.14 rjs #if 0
81 1.9 peter static int L3_read(struct uda1341_softc *, uint8_t, uint8_t *, int);
82 1.14 rjs #endif
83 1.9 peter static int L3_write(struct uda1341_softc *, uint8_t, uint8_t *, int);
84 1.1 ichiro
85 1.14 rjs CFATTACH_DECL_NEW(uda, sizeof(struct uda1341_softc),
86 1.4 thorpej uda1341_match, uda1341_attach, NULL, NULL);
87 1.1 ichiro
88 1.1 ichiro /*
89 1.1 ichiro * Philips L3 bus support.
90 1.1 ichiro * GPIO lines are used for clock, data and mode pins.
91 1.1 ichiro */
92 1.1 ichiro #define L3_DATA GPIO_H3600_L3_DATA
93 1.1 ichiro #define L3_MODE GPIO_H3600_L3_MODE
94 1.1 ichiro #define L3_CLK GPIO_H3600_L3_CLK
95 1.1 ichiro
96 1.1 ichiro static struct {
97 1.9 peter uint8_t data0; /* direct addressing register */
98 1.1 ichiro } DIRECT_REG = {0};
99 1.1 ichiro
100 1.1 ichiro static struct {
101 1.9 peter uint8_t data0; /* extended addressing register 1 */
102 1.9 peter uint8_t data1; /* extended addressing register 2 */
103 1.1 ichiro } EXTEND_REG = {0, 0};
104 1.1 ichiro
105 1.1 ichiro /*
106 1.1 ichiro * register space access macros
107 1.1 ichiro */
108 1.1 ichiro #define GPIO_WRITE(sc, reg, val) \
109 1.1 ichiro bus_space_write_4(sc->sc_iot, sc->sc_parent->sc_gpioh, reg, val)
110 1.1 ichiro #define GPIO_READ(sc, reg) \
111 1.1 ichiro bus_space_read_4(sc->sc_iot, sc->sc_parent->sc_gpioh, reg)
112 1.1 ichiro #define EGPIO_WRITE(sc) \
113 1.1 ichiro bus_space_write_2(sc->sc_iot, sc->sc_parent->sc_egpioh, \
114 1.1 ichiro 0, sc->sc_parent->ipaq_egpio)
115 1.1 ichiro #define SSP_WRITE(sc, reg, val) \
116 1.1 ichiro bus_space_write_4(sc->sc_iot, sc->sc_parent->sc_ssph, reg, val)
117 1.1 ichiro
118 1.1 ichiro static int
119 1.14 rjs uda1341_match(device_t parent, cfdata_t cf, 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.14 rjs uda1341_attach(device_t parent, device_t self, void *aux)
126 1.1 ichiro {
127 1.14 rjs struct uda1341_softc *sc = device_private(self);
128 1.14 rjs struct ipaq_softc *psc = device_private(parent);
129 1.1 ichiro
130 1.14 rjs aprint_normal("\n");
131 1.14 rjs aprint_normal_dev(self, "UDA1341 CODEC\n");
132 1.1 ichiro
133 1.14 rjs sc->sc_dev = self;
134 1.1 ichiro sc->sc_iot = psc->sc_iot;
135 1.1 ichiro sc->sc_ioh = psc->sc_ioh;
136 1.14 rjs sc->sc_parent = psc;
137 1.1 ichiro
138 1.1 ichiro uda1341_L3_init(sc);
139 1.1 ichiro uda1341_init(sc);
140 1.1 ichiro
141 1.1 ichiro uda1341_reset(sc);
142 1.1 ichiro
143 1.1 ichiro uda1341_reginit(sc);
144 1.1 ichiro
145 1.1 ichiro
146 1.1 ichiro /*
147 1.1 ichiro * Attach each devices
148 1.1 ichiro */
149 1.1 ichiro
150 1.6 drochner config_search_ia(uda1341_search, self, "udaif", NULL);
151 1.1 ichiro }
152 1.1 ichiro
153 1.1 ichiro static int
154 1.14 rjs uda1341_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
155 1.1 ichiro {
156 1.2 thorpej if (config_match(parent, cf, NULL) > 0)
157 1.1 ichiro config_attach(parent, cf, NULL, uda1341_print);
158 1.1 ichiro return 0;
159 1.1 ichiro }
160 1.1 ichiro
161 1.1 ichiro
162 1.1 ichiro static int
163 1.12 dsl uda1341_print(void *aux, const char *name)
164 1.1 ichiro {
165 1.1 ichiro return (UNCONF);
166 1.1 ichiro }
167 1.1 ichiro
168 1.1 ichiro static void
169 1.12 dsl uda1341_output_high(struct uda1341_softc *sc)
170 1.1 ichiro {
171 1.1 ichiro int cr;
172 1.1 ichiro
173 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, (L3_DATA | L3_MODE | L3_CLK));
174 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR) | (L3_DATA | L3_MODE | L3_CLK);
175 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
176 1.1 ichiro }
177 1.1 ichiro
178 1.1 ichiro static void
179 1.12 dsl uda1341_output_low(struct uda1341_softc *sc)
180 1.1 ichiro {
181 1.1 ichiro int cr;
182 1.1 ichiro
183 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR);
184 1.1 ichiro cr &= ~(L3_DATA | L3_MODE | L3_CLK);
185 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
186 1.1 ichiro }
187 1.1 ichiro
188 1.1 ichiro static void
189 1.12 dsl uda1341_L3_init(struct uda1341_softc *sc)
190 1.1 ichiro {
191 1.1 ichiro int cr;
192 1.1 ichiro
193 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_AFR);
194 1.1 ichiro cr &= ~(L3_DATA | L3_MODE | L3_CLK);
195 1.1 ichiro GPIO_WRITE(sc, SAGPIO_AFR, cr);
196 1.1 ichiro
197 1.1 ichiro uda1341_output_low(sc);
198 1.1 ichiro }
199 1.1 ichiro
200 1.1 ichiro static void
201 1.12 dsl uda1341_init(struct uda1341_softc *sc)
202 1.1 ichiro {
203 1.1 ichiro int cr;
204 1.1 ichiro
205 1.1 ichiro /* GPIO initialize */
206 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_AFR);
207 1.1 ichiro cr &= ~(GPIO_ALT_SSP_TXD | GPIO_ALT_SSP_RXD | GPIO_ALT_SSP_SCLK |
208 1.1 ichiro GPIO_ALT_SSP_SFRM);
209 1.1 ichiro cr |= GPIO_ALT_SSP_CLK;
210 1.1 ichiro GPIO_WRITE(sc, SAGPIO_AFR, cr);
211 1.1 ichiro
212 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR);
213 1.1 ichiro cr &= ~GPIO_ALT_SSP_CLK;
214 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
215 1.1 ichiro
216 1.1 ichiro /* SSP initialize & enable */
217 1.1 ichiro SSP_WRITE(sc, SASSP_CR1, CR1_ECS);
218 1.1 ichiro cr = 0xF | (CR0_FRF_MASK & (1<<4)) | (CR0_SCR_MASK & (3<<8)) | CR0_SSE;
219 1.1 ichiro SSP_WRITE(sc, SASSP_CR0, cr);
220 1.1 ichiro
221 1.1 ichiro /* Enable the audio power */
222 1.1 ichiro sc->sc_parent->ipaq_egpio |=
223 1.1 ichiro (EGPIO_H3600_AUD_PWRON | EGPIO_H3600_AUD_ON);
224 1.1 ichiro sc->sc_parent->ipaq_egpio &=
225 1.1 ichiro ~(EGPIO_H3600_CODEC_RESET | EGPIO_H3600_QMUTE);
226 1.1 ichiro EGPIO_WRITE(sc);
227 1.1 ichiro
228 1.1 ichiro /* external clock configured for 44100 samples/sec */
229 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR);
230 1.1 ichiro cr |= (GPIO_H3600_CLK_SET0 | GPIO_H3600_CLK_SET1);
231 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
232 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, GPIO_H3600_CLK_SET0);
233 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, GPIO_H3600_CLK_SET1);
234 1.1 ichiro
235 1.1 ichiro /* wait for power on */
236 1.1 ichiro delay(100*1000);
237 1.1 ichiro sc->sc_parent->ipaq_egpio |= EGPIO_H3600_CODEC_RESET;
238 1.1 ichiro EGPIO_WRITE(sc);
239 1.1 ichiro
240 1.1 ichiro /* Wait for the UDA1341 to wake up */
241 1.1 ichiro delay(100*1000);
242 1.1 ichiro }
243 1.1 ichiro
244 1.1 ichiro static void
245 1.14 rjs uda1341_reset(struct uda1341_softc *sc)
246 1.1 ichiro {
247 1.9 peter uint8_t command;
248 1.1 ichiro
249 1.1 ichiro command = (L3_ADDRESS_COM << 2) | L3_ADDRESS_STATUS;
250 1.1 ichiro DIRECT_REG.data0 = STATUS0_RST | STATUS0_SC_256 | STATUS0_IF_LSB16;
251 1.9 peter L3_write(sc, command, (uint8_t *) &DIRECT_REG, 1);
252 1.1 ichiro
253 1.1 ichiro sc->sc_parent->ipaq_egpio &= ~EGPIO_H3600_CODEC_RESET;
254 1.1 ichiro EGPIO_WRITE(sc);
255 1.1 ichiro sc->sc_parent->ipaq_egpio |= EGPIO_H3600_CODEC_RESET;
256 1.1 ichiro EGPIO_WRITE(sc);
257 1.1 ichiro
258 1.1 ichiro DIRECT_REG.data0 &= ~STATUS0_RST;
259 1.9 peter L3_write(sc, command, (uint8_t *) &DIRECT_REG, 1);
260 1.1 ichiro }
261 1.1 ichiro
262 1.1 ichiro static void
263 1.12 dsl uda1341_reginit(struct uda1341_softc *sc)
264 1.1 ichiro {
265 1.9 peter uint8_t command;
266 1.1 ichiro
267 1.1 ichiro /* STATUS 0 */
268 1.1 ichiro command = (L3_ADDRESS_COM << 2) | L3_ADDRESS_STATUS;
269 1.1 ichiro DIRECT_REG.data0 = STATUS0_SC_256 | STATUS0_IF_LSB16;
270 1.9 peter L3_write(sc, command, (uint8_t *) &DIRECT_REG, 1);
271 1.1 ichiro
272 1.1 ichiro /* STATUS 1 */
273 1.1 ichiro DIRECT_REG.data0 = STATUS1_OGS | STATUS1_IGS | (1<<7);
274 1.9 peter L3_write(sc, command, (uint8_t *) &DIRECT_REG, 1);
275 1.1 ichiro
276 1.1 ichiro /* DATA 0 */
277 1.1 ichiro command = (L3_ADDRESS_COM << 2) | L3_ADDRESS_DATA0;
278 1.1 ichiro DIRECT_REG.data0 = DATA0_VC(100) | DATA0_COMMON;
279 1.9 peter L3_write(sc, command, (uint8_t *) &DIRECT_REG, 1);
280 1.1 ichiro
281 1.1 ichiro /* DATA 1 */
282 1.1 ichiro DIRECT_REG.data0 = DATA1_BB(0) | DATA1_TR(0) | DATA1_COMMON;
283 1.9 peter L3_write(sc, command, (uint8_t *) &DIRECT_REG, 1);
284 1.1 ichiro
285 1.1 ichiro /* DATA 2*/
286 1.1 ichiro DIRECT_REG.data0 = DATA2_PP | DATA2_COMMON;
287 1.9 peter L3_write(sc, command, (uint8_t *) &DIRECT_REG, 1);
288 1.1 ichiro
289 1.1 ichiro /* Extended DATA 0 */
290 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E0;
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 1 */
295 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E1;
296 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | 0x4 ;
297 1.9 peter L3_write(sc, command, (uint8_t *) &EXTEND_REG, 2);
298 1.1 ichiro
299 1.1 ichiro /* Extended DATA 2 */
300 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E2;
301 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | DATA_E2_MS(30);
302 1.9 peter L3_write(sc, command, (uint8_t *) &EXTEND_REG, 2);
303 1.1 ichiro
304 1.1 ichiro /* Extended DATA 3 */
305 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E3;
306 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | DATA_E3_IG_L(0);
307 1.9 peter L3_write(sc, command, (uint8_t *) &EXTEND_REG, 2);
308 1.1 ichiro
309 1.1 ichiro /* Extended DATA 4 */
310 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E4;
311 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN | DATA_E4_IG_H(0);
312 1.9 peter L3_write(sc, command, (uint8_t *) &EXTEND_REG, 2);
313 1.1 ichiro
314 1.1 ichiro /* Extended DATA 5 */
315 1.1 ichiro EXTEND_REG.data0 = EXT_ADDR_COMMON | EXT_ADDR_E5;
316 1.1 ichiro EXTEND_REG.data1 = EXT_DATA_COMMN;
317 1.9 peter L3_write(sc, command, (uint8_t *) &EXTEND_REG, 2);
318 1.1 ichiro }
319 1.1 ichiro
320 1.14 rjs #if 0
321 1.1 ichiro static int
322 1.12 dsl L3_getbit(struct uda1341_softc *sc)
323 1.1 ichiro {
324 1.1 ichiro int cr, data;
325 1.1 ichiro
326 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
327 1.1 ichiro delay(L3_CLK_LOW);
328 1.1 ichiro
329 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PLR);
330 1.1 ichiro data = (cr & L3_DATA) ? 1 : 0;
331 1.1 ichiro
332 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
333 1.1 ichiro delay(L3_CLK_HIGH);
334 1.1 ichiro
335 1.1 ichiro return (data);
336 1.1 ichiro }
337 1.14 rjs #endif
338 1.1 ichiro
339 1.1 ichiro static void
340 1.12 dsl L3_sendbit(struct uda1341_softc *sc, int bit)
341 1.1 ichiro {
342 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
343 1.1 ichiro
344 1.1 ichiro if (bit & 0x01)
345 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_DATA);
346 1.1 ichiro else
347 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_DATA);
348 1.1 ichiro
349 1.1 ichiro delay(L3_CLK_LOW);
350 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
351 1.1 ichiro delay(L3_CLK_HIGH);
352 1.1 ichiro }
353 1.1 ichiro
354 1.14 rjs #if 0
355 1.9 peter static uint8_t
356 1.12 dsl L3_getbyte(struct uda1341_softc *sc, int mode)
357 1.1 ichiro {
358 1.1 ichiro int i;
359 1.9 peter uint8_t data;
360 1.1 ichiro
361 1.1 ichiro switch (mode) {
362 1.1 ichiro case 0: /* Address mode */
363 1.1 ichiro case 1: /* First data byte */
364 1.1 ichiro break;
365 1.1 ichiro default: /* second data byte via halt-Time */
366 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
367 1.1 ichiro delay(L3_HALT);
368 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
369 1.1 ichiro break;
370 1.1 ichiro }
371 1.1 ichiro
372 1.1 ichiro delay(L3_MODE_SETUP);
373 1.1 ichiro
374 1.1 ichiro for (i = 0; i < 8; i++)
375 1.1 ichiro data |= (L3_getbit(sc) << i);
376 1.1 ichiro
377 1.1 ichiro delay(L3_MODE_HOLD);
378 1.1 ichiro
379 1.1 ichiro return (data);
380 1.1 ichiro }
381 1.14 rjs #endif
382 1.1 ichiro
383 1.1 ichiro static void
384 1.12 dsl L3_sendbyte(struct uda1341_softc *sc, uint8_t data, int mode)
385 1.1 ichiro {
386 1.1 ichiro int i;
387 1.1 ichiro
388 1.1 ichiro switch (mode) {
389 1.1 ichiro case 0: /* Address mode */
390 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
391 1.1 ichiro break;
392 1.1 ichiro case 1: /* First data byte */
393 1.1 ichiro break;
394 1.1 ichiro default: /* second data byte via halt-Time */
395 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PCR, L3_CLK); /* Clock down */
396 1.1 ichiro delay(L3_HALT);
397 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
398 1.1 ichiro break;
399 1.1 ichiro }
400 1.1 ichiro
401 1.1 ichiro delay(L3_MODE_SETUP);
402 1.1 ichiro
403 1.1 ichiro for (i = 0; i < 8; i++)
404 1.1 ichiro L3_sendbit(sc, data >> i);
405 1.1 ichiro
406 1.1 ichiro if (mode == 0) /* Address mode */
407 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PSR, L3_CLK); /* Clock up */
408 1.1 ichiro
409 1.1 ichiro delay(L3_MODE_HOLD);
410 1.1 ichiro }
411 1.1 ichiro
412 1.14 rjs #if 0
413 1.1 ichiro static int
414 1.13 dsl L3_read(struct uda1341_softc *sc, uint8_t addr, uint8_t *data, int len)
415 1.1 ichiro {
416 1.1 ichiro int cr, mode;
417 1.1 ichiro mode = 0;
418 1.1 ichiro
419 1.1 ichiro uda1341_output_high(sc);
420 1.1 ichiro L3_sendbyte(sc, addr, mode++);
421 1.1 ichiro
422 1.1 ichiro cr = GPIO_READ(sc, SAGPIO_PDR);
423 1.1 ichiro cr &= ~(L3_DATA);
424 1.1 ichiro GPIO_WRITE(sc, SAGPIO_PDR, cr);
425 1.1 ichiro
426 1.1 ichiro while(len--)
427 1.1 ichiro *data++ = L3_getbyte(sc, mode++);
428 1.1 ichiro uda1341_output_low(sc);
429 1.1 ichiro
430 1.1 ichiro return len;
431 1.1 ichiro }
432 1.14 rjs #endif
433 1.1 ichiro
434 1.1 ichiro static int
435 1.13 dsl L3_write(struct uda1341_softc *sc, uint8_t addr, uint8_t *data, int len)
436 1.1 ichiro {
437 1.1 ichiro int mode = 0;
438 1.1 ichiro
439 1.1 ichiro uda1341_output_high(sc);
440 1.1 ichiro L3_sendbyte(sc, addr, mode++);
441 1.1 ichiro while(len--)
442 1.1 ichiro L3_sendbyte(sc, *data++, mode++);
443 1.1 ichiro uda1341_output_low(sc);
444 1.1 ichiro
445 1.1 ichiro return len;
446 1.1 ichiro }
447