audio_mini2440.c revision 1.4.4.1 1 1.1 nisimura /*-
2 1.1 nisimura * Copyright (c) 2012 The NetBSD Foundation, Inc.
3 1.1 nisimura * All rights reserved.
4 1.1 nisimura *
5 1.1 nisimura * This code is derived from software contributed to The NetBSD Foundation
6 1.1 nisimura * by Paul Fleischer <paul (at) xpg.dk>
7 1.1 nisimura *
8 1.1 nisimura * Redistribution and use in source and binary forms, with or without
9 1.1 nisimura * modification, are permitted provided that the following conditions
10 1.1 nisimura * are met:
11 1.1 nisimura * 1. Redistributions of source code must retain the above copyright
12 1.1 nisimura * notice, this list of conditions and the following disclaimer.
13 1.1 nisimura * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 nisimura * notice, this list of conditions and the following disclaimer in the
15 1.1 nisimura * documentation and/or other materials provided with the distribution.
16 1.1 nisimura *
17 1.1 nisimura * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
18 1.1 nisimura * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
19 1.1 nisimura * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
20 1.1 nisimura * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
21 1.1 nisimura * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
22 1.1 nisimura * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
23 1.1 nisimura * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
24 1.1 nisimura * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
25 1.1 nisimura * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
26 1.1 nisimura * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
27 1.1 nisimura * POSSIBILITY OF SUCH DAMAGE.
28 1.1 nisimura */
29 1.1 nisimura
30 1.1 nisimura #include <sys/cdefs.h>
31 1.1 nisimura #include <sys/param.h>
32 1.1 nisimura #include <sys/device.h>
33 1.1 nisimura #include <sys/malloc.h>
34 1.1 nisimura #include <sys/fcntl.h>
35 1.1 nisimura #include <sys/audioio.h>
36 1.1 nisimura
37 1.1 nisimura #include <sys/bus.h>
38 1.1 nisimura
39 1.3 isaki #include <dev/audio/audio_if.h>
40 1.1 nisimura
41 1.1 nisimura
42 1.1 nisimura #include <dev/ic/uda1341var.h>
43 1.1 nisimura
44 1.1 nisimura #include <arch/arm/s3c2xx0/s3c2440reg.h>
45 1.1 nisimura #include <arch/arm/s3c2xx0/s3c2440var.h>
46 1.1 nisimura
47 1.1 nisimura #include <arch/arm/s3c2xx0/s3c2440_dma.h>
48 1.1 nisimura #include <arch/arm/s3c2xx0/s3c2440_i2s.h>
49 1.1 nisimura
50 1.1 nisimura /*#define AUDIO_MINI2440_DEBUG*/
51 1.1 nisimura
52 1.1 nisimura #ifdef AUDIO_MINI2440_DEBUG
53 1.1 nisimura #define DPRINTF(x) do {printf x; } while (/*CONSTCOND*/0)
54 1.1 nisimura #else
55 1.1 nisimura #define DPRINTF(s) do {} while (/*CONSTCOND*/0)
56 1.1 nisimura #endif
57 1.1 nisimura
58 1.1 nisimura struct uda_softc {
59 1.1 nisimura device_t sc_dev;
60 1.1 nisimura kmutex_t sc_lock;
61 1.1 nisimura kmutex_t sc_intr_lock;
62 1.1 nisimura
63 1.1 nisimura struct uda1341_softc sc_uda1341;
64 1.1 nisimura
65 1.1 nisimura s3c2440_i2s_buf_t sc_play_buf;
66 1.1 nisimura s3c2440_i2s_buf_t sc_rec_buf;
67 1.1 nisimura
68 1.1 nisimura void *sc_i2s_handle;
69 1.1 nisimura };
70 1.1 nisimura
71 1.1 nisimura int uda_ssio_open(void *, int);
72 1.1 nisimura void uda_ssio_close(void *);
73 1.3 isaki int uda_ssio_query_format(void *, audio_format_query_t *);
74 1.3 isaki int uda_ssio_set_format(void *, int,
75 1.3 isaki const audio_params_t *, const audio_params_t *,
76 1.3 isaki audio_filter_reg_t *, audio_filter_reg_t *);
77 1.1 nisimura int uda_ssio_start_output(void *, void *, int, void (*)(void *),
78 1.1 nisimura void *);
79 1.1 nisimura int uda_ssio_start_input(void *, void *, int, void (*)(void *),
80 1.1 nisimura void *);
81 1.1 nisimura int uda_ssio_halt_output(void *);
82 1.1 nisimura int uda_ssio_halt_input(void *);
83 1.1 nisimura int uda_ssio_getdev(void *, struct audio_device *ret);
84 1.1 nisimura void* uda_ssio_allocm(void *, int, size_t);
85 1.1 nisimura void uda_ssio_freem(void *, void *, size_t);
86 1.1 nisimura size_t uda_ssio_round_buffersize(void *, int, size_t);
87 1.4 isaki int uda_ssio_get_props(void *);
88 1.1 nisimura void uda_ssio_get_locks(void *, kmutex_t**, kmutex_t**);
89 1.1 nisimura
90 1.1 nisimura struct audio_hw_if uda1341_hw_if = {
91 1.2 isaki .open = uda_ssio_open,
92 1.2 isaki .close = uda_ssio_close,
93 1.3 isaki .query_format = uda_ssio_query_format,
94 1.3 isaki .set_format = uda_ssio_set_format,
95 1.2 isaki .start_output = uda_ssio_start_output,
96 1.2 isaki .start_input = uda_ssio_start_input,
97 1.2 isaki .halt_output = uda_ssio_halt_output,
98 1.2 isaki .halt_input = uda_ssio_halt_input,
99 1.2 isaki .getdev = uda_ssio_getdev,
100 1.2 isaki .set_port = uda1341_set_port,
101 1.2 isaki .get_port = uda1341_get_port,
102 1.2 isaki .query_devinfo = uda1341_query_devinfo,
103 1.2 isaki .allocm = uda_ssio_allocm,
104 1.2 isaki .freem = uda_ssio_freem,
105 1.2 isaki .round_buffersize = uda_ssio_round_buffersize,
106 1.4 isaki .get_props = uda_ssio_get_props,
107 1.2 isaki .get_locks = uda_ssio_get_locks
108 1.1 nisimura };
109 1.1 nisimura
110 1.1 nisimura static struct audio_device uda1341_device = {
111 1.1 nisimura "MINI2240-UDA1341",
112 1.1 nisimura "0.1",
113 1.1 nisimura "uda_ssio"
114 1.1 nisimura };
115 1.1 nisimura
116 1.3 isaki static const struct audio_format uda_ssio_formats[] =
117 1.3 isaki {
118 1.3 isaki {
119 1.3 isaki .mode = AUMODE_PLAY | AUMODE_RECORD,
120 1.3 isaki .encoding = AUDIO_ENCODING_SLINEAR_LE,
121 1.3 isaki .validbits = 16,
122 1.3 isaki .precision = 16,
123 1.3 isaki .channels = 2,
124 1.3 isaki .channel_mask = AUFMT_STEREO,
125 1.3 isaki .frequency_type = 6,
126 1.3 isaki .frequency = { 8000, 11025, 22050, 32000, 44100, 48000 },
127 1.3 isaki }
128 1.3 isaki };
129 1.3 isaki #define UDA_SSIO_NFORMATS __arraycount(uda_ssio_formats)
130 1.3 isaki
131 1.1 nisimura void uda_ssio_l3_write(void *,int mode, int value);
132 1.1 nisimura
133 1.1 nisimura int uda_ssio_match(device_t, cfdata_t, void*);
134 1.1 nisimura void uda_ssio_attach(device_t, device_t, void*);
135 1.1 nisimura
136 1.1 nisimura CFATTACH_DECL_NEW(udassio, sizeof(struct uda_softc),
137 1.1 nisimura uda_ssio_match, uda_ssio_attach, NULL, NULL);
138 1.1 nisimura
139 1.1 nisimura int
140 1.1 nisimura uda_ssio_match(device_t parent, cfdata_t match, void *aux)
141 1.1 nisimura {
142 1.1 nisimura DPRINTF(("%s\n", __func__));
143 1.1 nisimura /* Not quite sure how we can detect the UDA1341 chip */
144 1.1 nisimura return 1;
145 1.1 nisimura }
146 1.1 nisimura
147 1.1 nisimura void
148 1.1 nisimura uda_ssio_attach(device_t parent, device_t self, void *aux)
149 1.1 nisimura {
150 1.1 nisimura /* struct s3c2xx0_attach_args *sa = aux;*/
151 1.1 nisimura struct uda_softc *sc = device_private(self);
152 1.1 nisimura struct s3c2xx0_softc *s3sc = s3c2xx0_softc; /* Shortcut */
153 1.1 nisimura struct s3c2440_i2s_attach_args *aa = aux;
154 1.1 nisimura uint32_t reg;
155 1.1 nisimura
156 1.1 nisimura sc->sc_dev = self;
157 1.1 nisimura
158 1.1 nisimura sc->sc_play_buf = NULL;
159 1.1 nisimura sc->sc_i2s_handle = aa->i2sa_handle;
160 1.1 nisimura
161 1.1 nisimura mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_NONE);
162 1.1 nisimura mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED);
163 1.1 nisimura
164 1.1 nisimura s3c2440_i2s_set_intr_lock(aa->i2sa_handle, &sc->sc_intr_lock);
165 1.1 nisimura
166 1.1 nisimura /* arch/arm/s3c2xx0/s3c2440.c initializes the I2S subsystem for us */
167 1.1 nisimura
168 1.1 nisimura /* Setup GPIO pins to output for L3 communication.
169 1.1 nisimura GPB3 (L3DATA) will have to be switched to input when reading
170 1.1 nisimura from the L3 bus.
171 1.1 nisimura
172 1.1 nisimura GPB2 - L3MODE
173 1.1 nisimura GPB3 - L3DATA
174 1.1 nisimura GPB4 - L3CLOCK
175 1.1 nisimura TODO: Make this configurable
176 1.1 nisimura */
177 1.1 nisimura reg = bus_space_read_4(s3sc->sc_iot, s3sc->sc_gpio_ioh, GPIO_PBCON);
178 1.1 nisimura reg = GPIO_SET_FUNC(reg, 2, 1);
179 1.1 nisimura reg = GPIO_SET_FUNC(reg, 3, 1);
180 1.1 nisimura reg = GPIO_SET_FUNC(reg, 4, 1);
181 1.1 nisimura bus_space_write_4(s3sc->sc_iot, s3sc->sc_gpio_ioh, GPIO_PBCON, reg);
182 1.1 nisimura
183 1.1 nisimura reg = bus_space_read_4(s3sc->sc_iot, s3sc->sc_gpio_ioh, GPIO_PBDAT);
184 1.1 nisimura reg = GPIO_SET_DATA(reg, 4, 1);
185 1.1 nisimura reg = GPIO_SET_DATA(reg, 3, 0);
186 1.1 nisimura reg = GPIO_SET_DATA(reg, 2, 1);
187 1.1 nisimura bus_space_write_4(s3sc->sc_iot, s3sc->sc_gpio_ioh, GPIO_PBDAT, reg);
188 1.1 nisimura
189 1.1 nisimura printf("\n");
190 1.1 nisimura
191 1.1 nisimura /* uda1341_attach resets the uda1341 sc, so it has to be called before
192 1.1 nisimura attributes are set on the sc.*/
193 1.1 nisimura uda1341_attach(&sc->sc_uda1341);
194 1.1 nisimura
195 1.1 nisimura /* Configure the UDA1341 Codec */
196 1.1 nisimura sc->sc_uda1341.parent = sc;
197 1.1 nisimura sc->sc_uda1341.sc_l3_write = uda_ssio_l3_write;
198 1.1 nisimura sc->sc_uda1341.sc_bus_format = UDA1341_BUS_MSB;
199 1.1 nisimura
200 1.1 nisimura /* Configure I2S controller */
201 1.1 nisimura s3c2440_i2s_set_bus_format(sc->sc_i2s_handle, S3C2440_I2S_BUS_MSB);
202 1.1 nisimura // Attach
203 1.1 nisimura audio_attach_mi(&uda1341_hw_if, &sc->sc_uda1341, self);
204 1.1 nisimura }
205 1.1 nisimura
206 1.1 nisimura int
207 1.1 nisimura uda_ssio_open(void *handle, int flags)
208 1.1 nisimura {
209 1.1 nisimura int retval;
210 1.1 nisimura
211 1.1 nisimura DPRINTF(("%s\n", __func__));
212 1.1 nisimura
213 1.1 nisimura /* We only support write operations */
214 1.1 nisimura if (!(flags & FREAD) && !(flags & FWRITE))
215 1.1 nisimura return EINVAL;
216 1.1 nisimura
217 1.1 nisimura /* We can't do much more at this point than to
218 1.1 nisimura ask the UDA1341 codec to initialize itself
219 1.1 nisimura (for an unknown system clock)
220 1.1 nisimura */
221 1.1 nisimura retval = uda1341_open(handle, flags);
222 1.1 nisimura if (retval != 0) {
223 1.1 nisimura return retval;
224 1.1 nisimura }
225 1.1 nisimura
226 1.1 nisimura return 0; /* SUCCESS */
227 1.1 nisimura }
228 1.1 nisimura
229 1.1 nisimura void
230 1.1 nisimura uda_ssio_close(void *handle)
231 1.1 nisimura {
232 1.3 isaki
233 1.1 nisimura DPRINTF(("%s\n", __func__));
234 1.1 nisimura
235 1.1 nisimura uda1341_close(handle);
236 1.1 nisimura }
237 1.1 nisimura
238 1.1 nisimura int
239 1.3 isaki uda_ssio_query_format(void *handle, audio_format_query_t *afp)
240 1.3 isaki {
241 1.3 isaki
242 1.3 isaki return audio_query_format(uda_ssio_formats, UDA_SSIO_NFORMATS, afp);
243 1.3 isaki }
244 1.3 isaki
245 1.3 isaki int
246 1.3 isaki uda_ssio_set_format(void *handle, int setmode,
247 1.3 isaki const audio_params_t *play, const audio_params_t *rec,
248 1.3 isaki audio_filter_reg_t *pfil, audio_filter_reg_t *rfil)
249 1.1 nisimura {
250 1.1 nisimura struct uda1341_softc *uc = handle;
251 1.1 nisimura struct uda_softc *sc = uc->parent;
252 1.1 nisimura int retval;
253 1.1 nisimura
254 1.1 nisimura DPRINTF(("%s: setmode: %d\n", __func__, setmode));
255 1.1 nisimura
256 1.3 isaki /* *play and *rec are the identical because !AUDIO_PROP_INDEPENDENT. */
257 1.1 nisimura
258 1.1 nisimura DPRINTF(("%s: %dHz, encoding: %d, precision: %d, channels: %d\n",
259 1.3 isaki __func__, play->sample_rate, play->encoding, play->precision,
260 1.3 isaki play->channels));
261 1.1 nisimura
262 1.1 nisimura if (setmode == AUMODE_PLAY) {
263 1.1 nisimura s3c2440_i2s_set_direction(sc->sc_i2s_handle,
264 1.1 nisimura S3C2440_I2S_TRANSMIT);
265 1.1 nisimura } else {
266 1.1 nisimura s3c2440_i2s_set_direction(sc->sc_i2s_handle,
267 1.1 nisimura S3C2440_I2S_RECEIVE);
268 1.1 nisimura }
269 1.1 nisimura
270 1.3 isaki s3c2440_i2s_set_sample_rate(sc->sc_i2s_handle, play->sample_rate);
271 1.3 isaki s3c2440_i2s_set_sample_width(sc->sc_i2s_handle, 16);
272 1.1 nisimura
273 1.1 nisimura /* It is vital that sc_system_clock is set PRIOR to calling
274 1.3 isaki uda1341_set_format. */
275 1.1 nisimura switch (s3c2440_i2s_get_master_clock(sc->sc_i2s_handle)) {
276 1.1 nisimura case 384:
277 1.1 nisimura uc->sc_system_clock = UDA1341_CLOCK_384;
278 1.1 nisimura break;
279 1.1 nisimura case 256:
280 1.1 nisimura uc->sc_system_clock = UDA1341_CLOCK_256;
281 1.1 nisimura break;
282 1.1 nisimura default:
283 1.1 nisimura return EINVAL;
284 1.1 nisimura }
285 1.1 nisimura
286 1.3 isaki retval = uda1341_set_format(handle, setmode, play, rec, pfil, rfil);
287 1.1 nisimura if (retval != 0) {
288 1.1 nisimura return retval;
289 1.1 nisimura }
290 1.1 nisimura
291 1.1 nisimura /* Setup and enable I2S controller */
292 1.1 nisimura retval = s3c2440_i2s_commit(sc->sc_i2s_handle);
293 1.1 nisimura if (retval != 0) {
294 1.1 nisimura printf("Failed to setup I2S controller\n");
295 1.1 nisimura return retval;
296 1.1 nisimura }
297 1.1 nisimura
298 1.1 nisimura return 0;
299 1.1 nisimura }
300 1.1 nisimura
301 1.1 nisimura int
302 1.1 nisimura uda_ssio_start_output(void *handle, void *block, int bsize,
303 1.1 nisimura void (*intr)(void *), void *intrarg)
304 1.1 nisimura {
305 1.1 nisimura struct uda1341_softc *uc = handle;
306 1.1 nisimura struct uda_softc *sc = uc->parent;
307 1.1 nisimura
308 1.1 nisimura return s3c2440_i2s_output(sc->sc_play_buf, block, bsize, intr, intrarg);
309 1.1 nisimura }
310 1.1 nisimura
311 1.1 nisimura int
312 1.1 nisimura uda_ssio_start_input(void *handle, void *block, int bsize,
313 1.1 nisimura void (*intr)(void *), void *intrarg)
314 1.1 nisimura {
315 1.1 nisimura struct uda1341_softc *uc = handle;
316 1.1 nisimura struct uda_softc *sc = uc->parent;
317 1.1 nisimura
318 1.1 nisimura return s3c2440_i2s_input(sc->sc_rec_buf, block, bsize, intr, intrarg);
319 1.1 nisimura }
320 1.1 nisimura
321 1.1 nisimura int
322 1.1 nisimura uda_ssio_halt_output(void *handle)
323 1.1 nisimura {
324 1.1 nisimura struct uda1341_softc *uc = handle;
325 1.1 nisimura struct uda_softc *sc = uc->parent;
326 1.1 nisimura
327 1.1 nisimura return s3c2440_i2s_halt_output(sc->sc_play_buf);
328 1.1 nisimura }
329 1.1 nisimura
330 1.1 nisimura int
331 1.1 nisimura uda_ssio_halt_input(void *handle)
332 1.1 nisimura {
333 1.1 nisimura DPRINTF(("%s\n", __func__));
334 1.1 nisimura return 0;
335 1.1 nisimura }
336 1.1 nisimura
337 1.1 nisimura int
338 1.1 nisimura uda_ssio_getdev(void *handle, struct audio_device *ret)
339 1.1 nisimura {
340 1.1 nisimura *ret = uda1341_device;
341 1.1 nisimura return 0;
342 1.1 nisimura }
343 1.1 nisimura
344 1.1 nisimura void *
345 1.1 nisimura uda_ssio_allocm(void *handle, int direction, size_t size)
346 1.1 nisimura {
347 1.1 nisimura struct uda1341_softc *uc = handle;
348 1.1 nisimura struct uda_softc *sc = uc->parent;
349 1.1 nisimura void *retval = NULL;
350 1.1 nisimura
351 1.1 nisimura DPRINTF(("%s\n", __func__));
352 1.1 nisimura
353 1.1 nisimura if (direction == AUMODE_PLAY ) {
354 1.1 nisimura if (sc->sc_play_buf != NULL)
355 1.1 nisimura return NULL;
356 1.1 nisimura
357 1.1 nisimura s3c2440_i2s_alloc(sc->sc_i2s_handle, direction, size, 0x00, &sc->sc_play_buf);
358 1.1 nisimura DPRINTF(("%s: addr of ring buffer: %p\n", __func__, sc->sc_play_buf->i2b_addr));
359 1.1 nisimura retval = sc->sc_play_buf->i2b_addr;
360 1.1 nisimura } else if (direction == AUMODE_RECORD) {
361 1.1 nisimura if (sc->sc_rec_buf != NULL)
362 1.1 nisimura return NULL;
363 1.1 nisimura
364 1.1 nisimura s3c2440_i2s_alloc(sc->sc_i2s_handle, direction, size, 0x00, &sc->sc_rec_buf);
365 1.1 nisimura DPRINTF(("%s: addr of ring buffer: %p\n", __func__, sc->sc_rec_buf->i2b_addr));
366 1.1 nisimura retval = sc->sc_rec_buf->i2b_addr;
367 1.1 nisimura }
368 1.1 nisimura
369 1.1 nisimura DPRINTF(("buffer: %p", retval));
370 1.1 nisimura
371 1.1 nisimura return retval;
372 1.1 nisimura }
373 1.1 nisimura
374 1.1 nisimura void
375 1.1 nisimura uda_ssio_freem(void *handle, void *ptr, size_t size)
376 1.1 nisimura {
377 1.1 nisimura struct uda1341_softc *uc = handle;
378 1.1 nisimura struct uda_softc *sc = uc->parent;
379 1.1 nisimura DPRINTF(("%s\n", __func__));
380 1.1 nisimura
381 1.1 nisimura if (ptr == sc->sc_play_buf->i2b_addr)
382 1.1 nisimura s3c2440_i2s_free(sc->sc_play_buf);
383 1.1 nisimura else if (ptr == sc->sc_rec_buf->i2b_addr)
384 1.1 nisimura s3c2440_i2s_free(sc->sc_rec_buf);
385 1.1 nisimura }
386 1.1 nisimura
387 1.1 nisimura size_t
388 1.1 nisimura uda_ssio_round_buffersize(void *handle, int direction, size_t bufsize)
389 1.1 nisimura {
390 1.1 nisimura DPRINTF(("%s: %d\n", __func__, (int)bufsize));
391 1.1 nisimura return bufsize;
392 1.1 nisimura }
393 1.1 nisimura
394 1.1 nisimura int
395 1.4 isaki uda_ssio_get_props(void *handle)
396 1.1 nisimura {
397 1.1 nisimura return AUDIO_PROP_PLAYBACK | AUDIO_PROP_CAPTURE;
398 1.1 nisimura }
399 1.1 nisimura
400 1.1 nisimura void
401 1.1 nisimura uda_ssio_get_locks(void *handle, kmutex_t **intr, kmutex_t **thread)
402 1.1 nisimura {
403 1.1 nisimura struct uda1341_softc *uc = handle;
404 1.1 nisimura struct uda_softc *sc = uc->parent;
405 1.1 nisimura //struct uda_softc *sc = handle;
406 1.1 nisimura
407 1.1 nisimura *intr = &sc->sc_intr_lock;
408 1.1 nisimura *thread = &sc->sc_lock;
409 1.1 nisimura }
410 1.1 nisimura
411 1.1 nisimura void
412 1.1 nisimura uda_ssio_l3_write(void *cookie, int mode, int value)
413 1.1 nisimura {
414 1.1 nisimura struct s3c2xx0_softc *s3sc = s3c2xx0_softc; /* Shortcut */
415 1.1 nisimura uint32_t reg;
416 1.1 nisimura
417 1.1 nisimura /* GPB2: L3MODE
418 1.1 nisimura GPB3: L2DATA
419 1.1 nisimura GPB4: L3CLOCK */
420 1.1 nisimura #define L3MODE 2
421 1.1 nisimura #define L3DATA 3
422 1.1 nisimura #define L3CLOCK 4
423 1.1 nisimura #define READ_GPIO() bus_space_read_4(s3sc->sc_iot, s3sc->sc_gpio_ioh, GPIO_PBDAT)
424 1.1 nisimura #define WRITE_GPIO(val) bus_space_write_4(s3sc->sc_iot, s3sc->sc_gpio_ioh, GPIO_PBDAT, val)
425 1.1 nisimura
426 1.1 nisimura #define DELAY_TIME 1
427 1.1 nisimura
428 1.1 nisimura reg = READ_GPIO();
429 1.1 nisimura reg = GPIO_SET_DATA(reg, L3CLOCK, 1);
430 1.1 nisimura reg = GPIO_SET_DATA(reg, L3MODE, mode);
431 1.1 nisimura reg = GPIO_SET_DATA(reg, L3DATA, 0);
432 1.1 nisimura WRITE_GPIO(reg);
433 1.1 nisimura
434 1.1 nisimura if (mode == 1 ) {
435 1.1 nisimura reg = READ_GPIO();
436 1.1 nisimura reg = GPIO_SET_DATA(reg, L3MODE, 1);
437 1.1 nisimura WRITE_GPIO(reg);
438 1.1 nisimura }
439 1.1 nisimura
440 1.1 nisimura DELAY(1); /* L3MODE setup time: min 190ns */
441 1.1 nisimura
442 1.1 nisimura for(int i = 0; i<8; i++) {
443 1.1 nisimura char bval = (value >> i) & 0x1;
444 1.1 nisimura
445 1.1 nisimura reg = READ_GPIO();
446 1.1 nisimura reg = GPIO_SET_DATA(reg, L3CLOCK, 0);
447 1.1 nisimura reg = GPIO_SET_DATA(reg, L3DATA, bval);
448 1.1 nisimura WRITE_GPIO(reg);
449 1.1 nisimura
450 1.1 nisimura DELAY(DELAY_TIME);
451 1.1 nisimura
452 1.1 nisimura reg = READ_GPIO();
453 1.1 nisimura reg = GPIO_SET_DATA(reg, L3CLOCK, 1);
454 1.1 nisimura reg = GPIO_SET_DATA(reg, L3DATA, bval);
455 1.1 nisimura WRITE_GPIO(reg);
456 1.1 nisimura
457 1.1 nisimura DELAY(DELAY_TIME);
458 1.1 nisimura }
459 1.1 nisimura
460 1.1 nisimura reg = READ_GPIO();
461 1.1 nisimura reg = GPIO_SET_DATA(reg, L3MODE, 1);
462 1.1 nisimura reg = GPIO_SET_DATA(reg, L3CLOCK, 1);
463 1.1 nisimura reg = GPIO_SET_DATA(reg, L3DATA, 0);
464 1.1 nisimura WRITE_GPIO(reg);
465 1.1 nisimura
466 1.1 nisimura #undef L3MODE
467 1.1 nisimura #undef L3DATA
468 1.1 nisimura #undef L3CLOCK
469 1.1 nisimura #undef DELAY_TIME
470 1.1 nisimura #undef READ_GPIO
471 1.1 nisimura #undef WRITE_GPIO
472 1.1 nisimura }
473