athflash.c revision 1.1.16.2 1 1.1.16.2 rpaulo /* $NetBSD: athflash.c,v 1.1.16.2 2006/09/09 02:41:25 rpaulo Exp $ */
2 1.1.16.2 rpaulo
3 1.1.16.2 rpaulo /*
4 1.1.16.2 rpaulo * Copyright (c) 2006 Urbana-Champaign Independent Media Center.
5 1.1.16.2 rpaulo * Copyright (c) 2006 Garrett D'Amore.
6 1.1.16.2 rpaulo * All rights reserved.
7 1.1.16.2 rpaulo *
8 1.1.16.2 rpaulo * Portions of this code were written by Garrett D'Amore for the
9 1.1.16.2 rpaulo * Champaign-Urbana Community Wireless Network Project.
10 1.1.16.2 rpaulo *
11 1.1.16.2 rpaulo * Redistribution and use in source and binary forms, with or
12 1.1.16.2 rpaulo * without modification, are permitted provided that the following
13 1.1.16.2 rpaulo * conditions are met:
14 1.1.16.2 rpaulo * 1. Redistributions of source code must retain the above copyright
15 1.1.16.2 rpaulo * notice, this list of conditions and the following disclaimer.
16 1.1.16.2 rpaulo * 2. Redistributions in binary form must reproduce the above
17 1.1.16.2 rpaulo * copyright notice, this list of conditions and the following
18 1.1.16.2 rpaulo * disclaimer in the documentation and/or other materials provided
19 1.1.16.2 rpaulo * with the distribution.
20 1.1.16.2 rpaulo * 3. All advertising materials mentioning features or use of this
21 1.1.16.2 rpaulo * software must display the following acknowledgements:
22 1.1.16.2 rpaulo * This product includes software developed by the Urbana-Champaign
23 1.1.16.2 rpaulo * Independent Media Center.
24 1.1.16.2 rpaulo * This product includes software developed by Garrett D'Amore.
25 1.1.16.2 rpaulo * 4. Urbana-Champaign Independent Media Center's name and Garrett
26 1.1.16.2 rpaulo * D'Amore's name may not be used to endorse or promote products
27 1.1.16.2 rpaulo * derived from this software without specific prior written permission.
28 1.1.16.2 rpaulo *
29 1.1.16.2 rpaulo * THIS SOFTWARE IS PROVIDED BY THE URBANA-CHAMPAIGN INDEPENDENT
30 1.1.16.2 rpaulo * MEDIA CENTER AND GARRETT D'AMORE ``AS IS'' AND ANY EXPRESS OR
31 1.1.16.2 rpaulo * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
32 1.1.16.2 rpaulo * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
33 1.1.16.2 rpaulo * ARE DISCLAIMED. IN NO EVENT SHALL THE URBANA-CHAMPAIGN INDEPENDENT
34 1.1.16.2 rpaulo * MEDIA CENTER OR GARRETT D'AMORE BE LIABLE FOR ANY DIRECT, INDIRECT,
35 1.1.16.2 rpaulo * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
36 1.1.16.2 rpaulo * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
37 1.1.16.2 rpaulo * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
38 1.1.16.2 rpaulo * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
39 1.1.16.2 rpaulo * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
40 1.1.16.2 rpaulo * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
41 1.1.16.2 rpaulo * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
42 1.1.16.2 rpaulo */
43 1.1.16.2 rpaulo /*
44 1.1.16.2 rpaulo * Copyright (c) 2002 The NetBSD Foundation, Inc.
45 1.1.16.2 rpaulo * All rights reserved.
46 1.1.16.2 rpaulo *
47 1.1.16.2 rpaulo * This code is derived from software contributed to The NetBSD Foundation
48 1.1.16.2 rpaulo * by Naoto Shimazaki of YOKOGAWA Electric Corporation.
49 1.1.16.2 rpaulo *
50 1.1.16.2 rpaulo * Redistribution and use in source and binary forms, with or without
51 1.1.16.2 rpaulo * modification, are permitted provided that the following conditions
52 1.1.16.2 rpaulo * are met:
53 1.1.16.2 rpaulo * 1. Redistributions of source code must retain the above copyright
54 1.1.16.2 rpaulo * notice, this list of conditions and the following disclaimer.
55 1.1.16.2 rpaulo * 2. Redistributions in binary form must reproduce the above copyright
56 1.1.16.2 rpaulo * notice, this list of conditions and the following disclaimer in the
57 1.1.16.2 rpaulo * documentation and/or other materials provided with the distribution.
58 1.1.16.2 rpaulo * 3. All advertising materials mentioning features or use of this software
59 1.1.16.2 rpaulo * must display the following acknowledgement:
60 1.1.16.2 rpaulo * This product includes software developed by the NetBSD
61 1.1.16.2 rpaulo * Foundation, Inc. and its contributors.
62 1.1.16.2 rpaulo * 4. Neither the name of The NetBSD Foundation nor the names of its
63 1.1.16.2 rpaulo * contributors may be used to endorse or promote products derived
64 1.1.16.2 rpaulo * from this software without specific prior written permission.
65 1.1.16.2 rpaulo *
66 1.1.16.2 rpaulo * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
67 1.1.16.2 rpaulo * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
68 1.1.16.2 rpaulo * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
69 1.1.16.2 rpaulo * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
70 1.1.16.2 rpaulo * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
71 1.1.16.2 rpaulo * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
72 1.1.16.2 rpaulo * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
73 1.1.16.2 rpaulo * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
74 1.1.16.2 rpaulo * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
75 1.1.16.2 rpaulo * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
76 1.1.16.2 rpaulo * POSSIBILITY OF SUCH DAMAGE.
77 1.1.16.2 rpaulo */
78 1.1.16.2 rpaulo
79 1.1.16.2 rpaulo /*
80 1.1.16.2 rpaulo * Flash Memory Driver
81 1.1.16.2 rpaulo *
82 1.1.16.2 rpaulo * XXX This primitive flash driver does *not* support boot sectored devices,
83 1.1.16.2 rpaulo * XXX and only supports a fairly limited set of devices, that we are likely to
84 1.1.16.2 rpaulo * XXX to find in an AP30.
85 1.1.16.2 rpaulo * XXX
86 1.1.16.2 rpaulo * XXX We also are only supporting flash widths of 16 _for the moment_, and
87 1.1.16.2 rpaulo * XXX we are only supporting flash devices that use the AMD command sets.
88 1.1.16.2 rpaulo * XXX All this should be reviewed and improved to be much more generic.
89 1.1.16.2 rpaulo */
90 1.1.16.2 rpaulo
91 1.1.16.2 rpaulo #include <sys/cdefs.h>
92 1.1.16.2 rpaulo __KERNEL_RCSID(0, "$NetBSD: athflash.c,v 1.1.16.2 2006/09/09 02:41:25 rpaulo Exp $");
93 1.1.16.2 rpaulo
94 1.1.16.2 rpaulo #include <sys/param.h>
95 1.1.16.2 rpaulo #include <sys/conf.h>
96 1.1.16.2 rpaulo #include <sys/device.h>
97 1.1.16.2 rpaulo #include <sys/kernel.h>
98 1.1.16.2 rpaulo #include <sys/malloc.h>
99 1.1.16.2 rpaulo #include <sys/proc.h>
100 1.1.16.2 rpaulo #include <sys/systm.h>
101 1.1.16.2 rpaulo
102 1.1.16.2 rpaulo #include <machine/bus.h>
103 1.1.16.2 rpaulo
104 1.1.16.2 rpaulo #include <mips/atheros/include/arbusvar.h>
105 1.1.16.2 rpaulo
106 1.1.16.2 rpaulo #ifdef FLASH_DEBUG
107 1.1.16.2 rpaulo int flash_debug = 0;
108 1.1.16.2 rpaulo #define DPRINTF(x) if (flash_debug) printf x
109 1.1.16.2 rpaulo #else
110 1.1.16.2 rpaulo #define DPRINTF(x)
111 1.1.16.2 rpaulo #endif
112 1.1.16.2 rpaulo
113 1.1.16.2 rpaulo struct flash_softc {
114 1.1.16.2 rpaulo struct device sc_dev;
115 1.1.16.2 rpaulo bus_space_tag_t sc_iot;
116 1.1.16.2 rpaulo bus_space_handle_t sc_ioh;
117 1.1.16.2 rpaulo size_t sc_size;
118 1.1.16.2 rpaulo size_t sc_sector_size;
119 1.1.16.2 rpaulo int sc_status;
120 1.1.16.2 rpaulo u_int8_t *sc_buf;
121 1.1.16.2 rpaulo };
122 1.1.16.2 rpaulo
123 1.1.16.2 rpaulo #define FLASH_ST_BUSY 0x1
124 1.1.16.2 rpaulo
125 1.1.16.2 rpaulo static int flash_probe(struct device *, struct cfdata *, void *);
126 1.1.16.2 rpaulo static void flash_attach(struct device *, struct device *, void *);
127 1.1.16.2 rpaulo
128 1.1.16.2 rpaulo static int is_block_same(struct flash_softc *, bus_size_t, const void *);
129 1.1.16.2 rpaulo static int toggle_bit_wait(struct flash_softc *, bus_size_t, int, int, int);
130 1.1.16.2 rpaulo
131 1.1.16.2 rpaulo static int flash_sector_erase(struct flash_softc *, bus_size_t);
132 1.1.16.2 rpaulo static int flash_sector_write(struct flash_softc *, bus_size_t);
133 1.1.16.2 rpaulo
134 1.1.16.2 rpaulo extern struct cfdriver athflash_cd;
135 1.1.16.2 rpaulo
136 1.1.16.2 rpaulo CFATTACH_DECL(athflash, sizeof(struct flash_softc),
137 1.1.16.2 rpaulo flash_probe, flash_attach, NULL, NULL);
138 1.1.16.2 rpaulo
139 1.1.16.2 rpaulo dev_type_open(flashopen);
140 1.1.16.2 rpaulo dev_type_close(flashclose);
141 1.1.16.2 rpaulo dev_type_read(flashread);
142 1.1.16.2 rpaulo dev_type_write(flashwrite);
143 1.1.16.2 rpaulo
144 1.1.16.2 rpaulo const struct cdevsw athflash_cdevsw = {
145 1.1.16.2 rpaulo flashopen, flashclose, flashread, flashwrite, noioctl,
146 1.1.16.2 rpaulo nostop, notty, nopoll, nommap, nokqfilter,
147 1.1.16.2 rpaulo };
148 1.1.16.2 rpaulo
149 1.1.16.2 rpaulo static struct {
150 1.1.16.2 rpaulo uint16_t vendor_id;
151 1.1.16.2 rpaulo uint16_t device_id;
152 1.1.16.2 rpaulo const char *name;
153 1.1.16.2 rpaulo int sector_size;
154 1.1.16.2 rpaulo int flash_size;
155 1.1.16.2 rpaulo } flash_ids[] = {
156 1.1.16.2 rpaulo { 0x00bf, 0x2780, "SST 39VF400", 0x01000, 0x080000 }, /* 512KB */
157 1.1.16.2 rpaulo { 0x00bf, 0x2782, "SST 39VF160", 0x01000, 0x200000 }, /* 2MB */
158 1.1.16.2 rpaulo { 0xffff, 0xffff, NULL, 0, 0 } /* end list */
159 1.1.16.2 rpaulo };
160 1.1.16.2 rpaulo
161 1.1.16.2 rpaulo static int
162 1.1.16.2 rpaulo flash_probe(struct device *parent, struct cfdata *cf, void *aux)
163 1.1.16.2 rpaulo {
164 1.1.16.2 rpaulo struct arbus_attach_args *aa = aux;
165 1.1.16.2 rpaulo bus_space_handle_t ioh;
166 1.1.16.2 rpaulo int rv = 0, i;
167 1.1.16.2 rpaulo uint16_t venid, devid;
168 1.1.16.2 rpaulo
169 1.1.16.2 rpaulo if (strcmp(aa->aa_name, cf->cf_name) != 0)
170 1.1.16.2 rpaulo return 0;
171 1.1.16.2 rpaulo
172 1.1.16.2 rpaulo DPRINTF(("trying to map address %x\n", (unsigned)aa->aa_addr));
173 1.1.16.2 rpaulo if (bus_space_map(aa->aa_bst, aa->aa_addr, aa->aa_size, 0, &ioh))
174 1.1.16.2 rpaulo return 0;
175 1.1.16.2 rpaulo
176 1.1.16.2 rpaulo /* issue JEDEC query */
177 1.1.16.2 rpaulo DPRINTF(("issuing JEDEC query\n"));
178 1.1.16.2 rpaulo bus_space_write_2(aa->aa_bst, ioh, (0x5555 << 1), 0xAAAA);
179 1.1.16.2 rpaulo bus_space_write_2(aa->aa_bst, ioh, (0x2AAA << 1), 0x5555);
180 1.1.16.2 rpaulo bus_space_write_2(aa->aa_bst, ioh, (0x5555 << 1), 0x9090);
181 1.1.16.2 rpaulo
182 1.1.16.2 rpaulo delay(100);
183 1.1.16.2 rpaulo venid = bus_space_read_2(aa->aa_bst, ioh, 0);
184 1.1.16.2 rpaulo devid = bus_space_read_2(aa->aa_bst, ioh, 2);
185 1.1.16.2 rpaulo
186 1.1.16.2 rpaulo /* issue software exit */
187 1.1.16.2 rpaulo bus_space_write_2(aa->aa_bst, ioh, 0x0, 0xF0F0);
188 1.1.16.2 rpaulo
189 1.1.16.2 rpaulo for (i = 0; flash_ids[i].name != NULL; i++) {
190 1.1.16.2 rpaulo if ((venid == flash_ids[i].vendor_id) &&
191 1.1.16.2 rpaulo (devid == flash_ids[i].device_id)) {
192 1.1.16.2 rpaulo rv = 1;
193 1.1.16.2 rpaulo break;
194 1.1.16.2 rpaulo }
195 1.1.16.2 rpaulo }
196 1.1.16.2 rpaulo
197 1.1.16.2 rpaulo bus_space_unmap(aa->aa_bst, ioh, aa->aa_size);
198 1.1.16.2 rpaulo return rv;
199 1.1.16.2 rpaulo }
200 1.1.16.2 rpaulo
201 1.1.16.2 rpaulo static void
202 1.1.16.2 rpaulo flash_attach(struct device *parent, struct device *self, void *aux)
203 1.1.16.2 rpaulo {
204 1.1.16.2 rpaulo struct flash_softc *sc = (void *) self;
205 1.1.16.2 rpaulo struct arbus_attach_args *aa = aux;
206 1.1.16.2 rpaulo int i;
207 1.1.16.2 rpaulo bus_space_tag_t iot = aa->aa_bst;
208 1.1.16.2 rpaulo bus_space_handle_t ioh;
209 1.1.16.2 rpaulo uint16_t venid, devid;
210 1.1.16.2 rpaulo
211 1.1.16.2 rpaulo if (bus_space_map(iot, aa->aa_addr, aa->aa_size, 0, &ioh)) {
212 1.1.16.2 rpaulo printf(": can't map i/o space\n");
213 1.1.16.2 rpaulo return;
214 1.1.16.2 rpaulo }
215 1.1.16.2 rpaulo
216 1.1.16.2 rpaulo sc->sc_iot = iot;
217 1.1.16.2 rpaulo sc->sc_ioh = ioh;
218 1.1.16.2 rpaulo sc->sc_status = 0;
219 1.1.16.2 rpaulo
220 1.1.16.2 rpaulo /* issue JEDEC query */
221 1.1.16.2 rpaulo bus_space_write_2(aa->aa_bst, ioh, (0x5555 << 1), 0xAAAA);
222 1.1.16.2 rpaulo bus_space_write_2(aa->aa_bst, ioh, (0x2AAA << 1), 0x5555);
223 1.1.16.2 rpaulo bus_space_write_2(aa->aa_bst, ioh, (0x5555 << 1), 0x9090);
224 1.1.16.2 rpaulo
225 1.1.16.2 rpaulo delay(100);
226 1.1.16.2 rpaulo venid = bus_space_read_2(aa->aa_bst, ioh, 0);
227 1.1.16.2 rpaulo devid = bus_space_read_2(aa->aa_bst, ioh, 2);
228 1.1.16.2 rpaulo
229 1.1.16.2 rpaulo /* issue software exit */
230 1.1.16.2 rpaulo bus_space_write_2(aa->aa_bst, ioh, 0x0, 0xF0F0);
231 1.1.16.2 rpaulo
232 1.1.16.2 rpaulo for (i = 0; flash_ids[i].name != NULL; i++) {
233 1.1.16.2 rpaulo if ((venid == flash_ids[i].vendor_id) &&
234 1.1.16.2 rpaulo (devid == flash_ids[i].device_id)) {
235 1.1.16.2 rpaulo break;
236 1.1.16.2 rpaulo }
237 1.1.16.2 rpaulo }
238 1.1.16.2 rpaulo
239 1.1.16.2 rpaulo KASSERT(flash_ids[i].name != NULL);
240 1.1.16.2 rpaulo printf(": %s ", flash_ids[i].name);
241 1.1.16.2 rpaulo if (i >= 0x100000)
242 1.1.16.2 rpaulo printf("(%d MB)", flash_ids[i].flash_size >> 20);
243 1.1.16.2 rpaulo else
244 1.1.16.2 rpaulo printf("(%d KB)", flash_ids[i].flash_size >> 10);
245 1.1.16.2 rpaulo
246 1.1.16.2 rpaulo /*
247 1.1.16.2 rpaulo * determine size of the largest block
248 1.1.16.2 rpaulo */
249 1.1.16.2 rpaulo sc->sc_size = flash_ids[i].flash_size;
250 1.1.16.2 rpaulo sc->sc_sector_size = flash_ids[i].sector_size;
251 1.1.16.2 rpaulo
252 1.1.16.2 rpaulo if ((sc->sc_buf = malloc(sc->sc_sector_size, M_DEVBUF, M_NOWAIT))
253 1.1.16.2 rpaulo == NULL) {
254 1.1.16.2 rpaulo printf(": can't alloc buffer space\n");
255 1.1.16.2 rpaulo return;
256 1.1.16.2 rpaulo }
257 1.1.16.2 rpaulo
258 1.1.16.2 rpaulo printf("\n");
259 1.1.16.2 rpaulo }
260 1.1.16.2 rpaulo
261 1.1.16.2 rpaulo int
262 1.1.16.2 rpaulo flashopen(dev_t dev, int flag, int mode, struct lwp *l)
263 1.1.16.2 rpaulo {
264 1.1.16.2 rpaulo struct flash_softc *sc;
265 1.1.16.2 rpaulo
266 1.1.16.2 rpaulo if ((sc = device_lookup(&athflash_cd, minor(dev))) == NULL)
267 1.1.16.2 rpaulo return ENXIO;
268 1.1.16.2 rpaulo if (sc->sc_status & FLASH_ST_BUSY)
269 1.1.16.2 rpaulo return EBUSY;
270 1.1.16.2 rpaulo sc->sc_status |= FLASH_ST_BUSY;
271 1.1.16.2 rpaulo return 0;
272 1.1.16.2 rpaulo }
273 1.1.16.2 rpaulo
274 1.1.16.2 rpaulo int
275 1.1.16.2 rpaulo flashclose(dev_t dev, int flag, int mode, struct lwp *l)
276 1.1.16.2 rpaulo {
277 1.1.16.2 rpaulo struct flash_softc *sc;
278 1.1.16.2 rpaulo
279 1.1.16.2 rpaulo sc = device_lookup(&athflash_cd, minor(dev));
280 1.1.16.2 rpaulo sc->sc_status &= ~FLASH_ST_BUSY;
281 1.1.16.2 rpaulo return 0;
282 1.1.16.2 rpaulo }
283 1.1.16.2 rpaulo
284 1.1.16.2 rpaulo int
285 1.1.16.2 rpaulo flashread(dev_t dev, struct uio *uio, int flag)
286 1.1.16.2 rpaulo {
287 1.1.16.2 rpaulo struct flash_softc *sc;
288 1.1.16.2 rpaulo bus_space_tag_t iot;
289 1.1.16.2 rpaulo bus_space_handle_t ioh;
290 1.1.16.2 rpaulo bus_size_t off;
291 1.1.16.2 rpaulo int total;
292 1.1.16.2 rpaulo int count;
293 1.1.16.2 rpaulo int error;
294 1.1.16.2 rpaulo
295 1.1.16.2 rpaulo sc = device_lookup(&athflash_cd, minor(dev));
296 1.1.16.2 rpaulo iot = sc->sc_iot;
297 1.1.16.2 rpaulo ioh = sc->sc_ioh;
298 1.1.16.2 rpaulo
299 1.1.16.2 rpaulo off = uio->uio_offset;
300 1.1.16.2 rpaulo total = min(sc->sc_size - off, uio->uio_resid);
301 1.1.16.2 rpaulo
302 1.1.16.2 rpaulo while (total > 0) {
303 1.1.16.2 rpaulo count = min(sc->sc_sector_size, uio->uio_resid);
304 1.1.16.2 rpaulo bus_space_read_region_1(iot, ioh, off, sc->sc_buf, count);
305 1.1.16.2 rpaulo if ((error = uiomove(sc->sc_buf, count, uio)) != 0)
306 1.1.16.2 rpaulo return error;
307 1.1.16.2 rpaulo off += count;
308 1.1.16.2 rpaulo total -= count;
309 1.1.16.2 rpaulo }
310 1.1.16.2 rpaulo return 0;
311 1.1.16.2 rpaulo }
312 1.1.16.2 rpaulo
313 1.1.16.2 rpaulo
314 1.1.16.2 rpaulo int
315 1.1.16.2 rpaulo flashwrite(dev_t dev, struct uio *uio, int flag)
316 1.1.16.2 rpaulo {
317 1.1.16.2 rpaulo struct flash_softc *sc;
318 1.1.16.2 rpaulo bus_space_tag_t iot;
319 1.1.16.2 rpaulo bus_space_handle_t ioh;
320 1.1.16.2 rpaulo bus_size_t off;
321 1.1.16.2 rpaulo int stat;
322 1.1.16.2 rpaulo int error;
323 1.1.16.2 rpaulo
324 1.1.16.2 rpaulo sc = device_lookup(&athflash_cd, minor(dev));
325 1.1.16.2 rpaulo
326 1.1.16.2 rpaulo if (sc->sc_size < uio->uio_offset + uio->uio_resid)
327 1.1.16.2 rpaulo return ENOSPC;
328 1.1.16.2 rpaulo if (uio->uio_offset % sc->sc_sector_size)
329 1.1.16.2 rpaulo return EINVAL;
330 1.1.16.2 rpaulo if (uio->uio_resid % sc->sc_sector_size)
331 1.1.16.2 rpaulo return EINVAL;
332 1.1.16.2 rpaulo
333 1.1.16.2 rpaulo iot = sc->sc_iot;
334 1.1.16.2 rpaulo ioh = sc->sc_ioh;
335 1.1.16.2 rpaulo
336 1.1.16.2 rpaulo for (off = uio->uio_offset;
337 1.1.16.2 rpaulo uio->uio_resid > 0;
338 1.1.16.2 rpaulo off += sc->sc_sector_size) {
339 1.1.16.2 rpaulo error = uiomove(sc->sc_buf, sc->sc_sector_size, uio);
340 1.1.16.2 rpaulo if (error != 0)
341 1.1.16.2 rpaulo return error;
342 1.1.16.2 rpaulo if (is_block_same(sc, off, sc->sc_buf))
343 1.1.16.2 rpaulo continue;
344 1.1.16.2 rpaulo if ((stat = flash_sector_erase(sc, off)) != 0) {
345 1.1.16.2 rpaulo printf("sector erase failed status = 0x%x\n", stat);
346 1.1.16.2 rpaulo return EIO;
347 1.1.16.2 rpaulo }
348 1.1.16.2 rpaulo if ((stat = flash_sector_write(sc, off)) != 0) {
349 1.1.16.2 rpaulo printf("sector write failed status = 0x%x\n", stat);
350 1.1.16.2 rpaulo return EIO;
351 1.1.16.2 rpaulo }
352 1.1.16.2 rpaulo }
353 1.1.16.2 rpaulo return 0;
354 1.1.16.2 rpaulo }
355 1.1.16.2 rpaulo
356 1.1.16.2 rpaulo static int
357 1.1.16.2 rpaulo is_block_same(struct flash_softc *sc, bus_size_t offset, const void *bufp)
358 1.1.16.2 rpaulo {
359 1.1.16.2 rpaulo bus_space_tag_t iot = sc->sc_iot;
360 1.1.16.2 rpaulo bus_space_handle_t ioh = sc->sc_ioh;
361 1.1.16.2 rpaulo const u_int8_t *p = bufp;
362 1.1.16.2 rpaulo int count = sc->sc_sector_size;
363 1.1.16.2 rpaulo
364 1.1.16.2 rpaulo while (count-- > 0) {
365 1.1.16.2 rpaulo if (bus_space_read_1(iot, ioh, offset++) != *p++)
366 1.1.16.2 rpaulo return 0;
367 1.1.16.2 rpaulo }
368 1.1.16.2 rpaulo return 1;
369 1.1.16.2 rpaulo }
370 1.1.16.2 rpaulo
371 1.1.16.2 rpaulo static int
372 1.1.16.2 rpaulo toggle_bit_wait(struct flash_softc *sc, bus_size_t offset,
373 1.1.16.2 rpaulo int typtmo, int maxtmo, int spin)
374 1.1.16.2 rpaulo {
375 1.1.16.2 rpaulo bus_space_tag_t iot = sc->sc_iot;
376 1.1.16.2 rpaulo bus_space_handle_t ioh = sc->sc_ioh;
377 1.1.16.2 rpaulo uint8_t d1, d2;
378 1.1.16.2 rpaulo
379 1.1.16.2 rpaulo while (maxtmo > 0) {
380 1.1.16.2 rpaulo
381 1.1.16.2 rpaulo if (spin) {
382 1.1.16.2 rpaulo DELAY(typtmo);
383 1.1.16.2 rpaulo } else {
384 1.1.16.2 rpaulo tsleep(sc, PRIBIO, "blockerase",
385 1.1.16.2 rpaulo (typtmo / hz) + 1);
386 1.1.16.2 rpaulo }
387 1.1.16.2 rpaulo
388 1.1.16.2 rpaulo d1 = bus_space_read_1(iot, ioh, offset);
389 1.1.16.2 rpaulo d2 = bus_space_read_2(iot, ioh, offset);
390 1.1.16.2 rpaulo
391 1.1.16.2 rpaulo /* watch for the toggle bit to stop toggling */
392 1.1.16.2 rpaulo if ((d1 & 0x40) == (d2 & 0x40)) {
393 1.1.16.2 rpaulo return 0;
394 1.1.16.2 rpaulo }
395 1.1.16.2 rpaulo
396 1.1.16.2 rpaulo maxtmo -= typtmo;
397 1.1.16.2 rpaulo }
398 1.1.16.2 rpaulo return (ETIMEDOUT);
399 1.1.16.2 rpaulo }
400 1.1.16.2 rpaulo
401 1.1.16.2 rpaulo static int
402 1.1.16.2 rpaulo flash_sector_erase(struct flash_softc *sc, bus_size_t offset)
403 1.1.16.2 rpaulo {
404 1.1.16.2 rpaulo bus_space_tag_t iot = sc->sc_iot;
405 1.1.16.2 rpaulo bus_space_handle_t ioh = sc->sc_ioh;
406 1.1.16.2 rpaulo
407 1.1.16.2 rpaulo DPRINTF(("flash_sector_erase offset = %08lx\n", offset));
408 1.1.16.2 rpaulo
409 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, (0x5555 << 1), 0xAAAA);
410 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, (0x2AAA << 1), 0x5555);
411 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, (0x5555 << 1), 0x8080);
412 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, (0x5555 << 1), 0xAAAA);
413 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, (0x2AAA << 1), 0x5555);
414 1.1.16.2 rpaulo
415 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, offset, 0x3030);
416 1.1.16.2 rpaulo
417 1.1.16.2 rpaulo /*
418 1.1.16.2 rpaulo * NB: with CFI, we could get more meaningful timeout data for
419 1.1.16.2 rpaulo * now we just assign reasonable values - 10 msec typical, and
420 1.1.16.2 rpaulo * up to 60 secs to erase the whole sector.
421 1.1.16.2 rpaulo */
422 1.1.16.2 rpaulo
423 1.1.16.2 rpaulo return toggle_bit_wait(sc, offset, 10000, 60000000, 0);
424 1.1.16.2 rpaulo }
425 1.1.16.2 rpaulo
426 1.1.16.2 rpaulo static int
427 1.1.16.2 rpaulo flash_sector_write(struct flash_softc *sc, bus_size_t offset)
428 1.1.16.2 rpaulo {
429 1.1.16.2 rpaulo bus_space_tag_t iot = sc->sc_iot;
430 1.1.16.2 rpaulo bus_space_handle_t ioh = sc->sc_ioh;
431 1.1.16.2 rpaulo bus_size_t fence;
432 1.1.16.2 rpaulo const u_int16_t *p;
433 1.1.16.2 rpaulo
434 1.1.16.2 rpaulo p = (u_int16_t *) sc->sc_buf;
435 1.1.16.2 rpaulo fence = offset + sc->sc_sector_size;
436 1.1.16.2 rpaulo do {
437 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, (0x5555 << 1), 0xAAAA);
438 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, (0x2AAA << 1), 0x5555);
439 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, (0xAAAA << 1), 0xA0A0);
440 1.1.16.2 rpaulo
441 1.1.16.2 rpaulo bus_space_write_2(iot, ioh, offset, *p);
442 1.1.16.2 rpaulo
443 1.1.16.2 rpaulo /* wait up to 1 msec, in 10 usec increments, no sleeping */
444 1.1.16.2 rpaulo if (toggle_bit_wait(sc, offset, 10, 1000, 1) != 0)
445 1.1.16.2 rpaulo return ETIMEDOUT;
446 1.1.16.2 rpaulo p++;
447 1.1.16.2 rpaulo offset += 2;
448 1.1.16.2 rpaulo } while (offset < fence);
449 1.1.16.2 rpaulo
450 1.1.16.2 rpaulo return 0;
451 1.1.16.2 rpaulo }
452