Statistics
| Branch: | Revision:

root / hw / onenand.c @ baaa86d9

History | View | Annotate | Download (21.4 kB)

1 7e7c5e4c balrog
/*
2 7e7c5e4c balrog
 * OneNAND flash memories emulation.
3 7e7c5e4c balrog
 *
4 7e7c5e4c balrog
 * Copyright (C) 2008 Nokia Corporation
5 7e7c5e4c balrog
 * Written by Andrzej Zaborowski <andrew@openedhand.com>
6 7e7c5e4c balrog
 *
7 7e7c5e4c balrog
 * This program is free software; you can redistribute it and/or
8 7e7c5e4c balrog
 * modify it under the terms of the GNU General Public License as
9 7e7c5e4c balrog
 * published by the Free Software Foundation; either version 2 or
10 7e7c5e4c balrog
 * (at your option) version 3 of the License.
11 7e7c5e4c balrog
 *
12 7e7c5e4c balrog
 * This program is distributed in the hope that it will be useful,
13 7e7c5e4c balrog
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 7e7c5e4c balrog
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15 7e7c5e4c balrog
 * GNU General Public License for more details.
16 7e7c5e4c balrog
 *
17 fad6cb1a aurel32
 * You should have received a copy of the GNU General Public License along
18 8167ee88 Blue Swirl
 * with this program; if not, see <http://www.gnu.org/licenses/>.
19 7e7c5e4c balrog
 */
20 7e7c5e4c balrog
21 7e7c5e4c balrog
#include "qemu-common.h"
22 34f9f0b5 Dmitry Eremin-Solenikov
#include "hw.h"
23 7e7c5e4c balrog
#include "flash.h"
24 7e7c5e4c balrog
#include "irq.h"
25 666daa68 Markus Armbruster
#include "blockdev.h"
26 7e7c5e4c balrog
27 7e7c5e4c balrog
/* 11 for 2kB-page OneNAND ("2nd generation") and 10 for 1kB-page chips */
28 7e7c5e4c balrog
#define PAGE_SHIFT        11
29 7e7c5e4c balrog
30 7e7c5e4c balrog
/* Fixed */
31 7e7c5e4c balrog
#define BLOCK_SHIFT        (PAGE_SHIFT + 6)
32 7e7c5e4c balrog
33 bc24a225 Paul Brook
typedef struct {
34 5923ba42 Juha Riihimäki
    struct {
35 5923ba42 Juha Riihimäki
        uint16_t man;
36 5923ba42 Juha Riihimäki
        uint16_t dev;
37 5923ba42 Juha Riihimäki
        uint16_t ver;
38 5923ba42 Juha Riihimäki
    } id;
39 7e7c5e4c balrog
    int shift;
40 c227f099 Anthony Liguori
    target_phys_addr_t base;
41 7e7c5e4c balrog
    qemu_irq intr;
42 7e7c5e4c balrog
    qemu_irq rdy;
43 7e7c5e4c balrog
    BlockDriverState *bdrv;
44 7e7c5e4c balrog
    BlockDriverState *bdrv_cur;
45 7e7c5e4c balrog
    uint8_t *image;
46 7e7c5e4c balrog
    uint8_t *otp;
47 7e7c5e4c balrog
    uint8_t *current;
48 c227f099 Anthony Liguori
    ram_addr_t ram;
49 7e7c5e4c balrog
    uint8_t *boot[2];
50 7e7c5e4c balrog
    uint8_t *data[2][2];
51 7e7c5e4c balrog
    int iomemtype;
52 7e7c5e4c balrog
    int cycle;
53 7e7c5e4c balrog
    int otpmode;
54 7e7c5e4c balrog
55 7e7c5e4c balrog
    uint16_t addr[8];
56 7e7c5e4c balrog
    uint16_t unladdr[8];
57 7e7c5e4c balrog
    int bufaddr;
58 7e7c5e4c balrog
    int count;
59 7e7c5e4c balrog
    uint16_t command;
60 7e7c5e4c balrog
    uint16_t config[2];
61 7e7c5e4c balrog
    uint16_t status;
62 7e7c5e4c balrog
    uint16_t intstatus;
63 7e7c5e4c balrog
    uint16_t wpstatus;
64 7e7c5e4c balrog
65 bc24a225 Paul Brook
    ECCState ecc;
66 7e7c5e4c balrog
67 7e7c5e4c balrog
    int density_mask;
68 7e7c5e4c balrog
    int secs;
69 7e7c5e4c balrog
    int secs_cur;
70 7e7c5e4c balrog
    int blocks;
71 7e7c5e4c balrog
    uint8_t *blockwp;
72 bc24a225 Paul Brook
} OneNANDState;
73 7e7c5e4c balrog
74 7e7c5e4c balrog
enum {
75 7e7c5e4c balrog
    ONEN_BUF_BLOCK = 0,
76 7e7c5e4c balrog
    ONEN_BUF_BLOCK2 = 1,
77 7e7c5e4c balrog
    ONEN_BUF_DEST_BLOCK = 2,
78 7e7c5e4c balrog
    ONEN_BUF_DEST_PAGE = 3,
79 7e7c5e4c balrog
    ONEN_BUF_PAGE = 7,
80 7e7c5e4c balrog
};
81 7e7c5e4c balrog
82 7e7c5e4c balrog
enum {
83 7e7c5e4c balrog
    ONEN_ERR_CMD = 1 << 10,
84 7e7c5e4c balrog
    ONEN_ERR_ERASE = 1 << 11,
85 7e7c5e4c balrog
    ONEN_ERR_PROG = 1 << 12,
86 7e7c5e4c balrog
    ONEN_ERR_LOAD = 1 << 13,
87 7e7c5e4c balrog
};
88 7e7c5e4c balrog
89 7e7c5e4c balrog
enum {
90 7e7c5e4c balrog
    ONEN_INT_RESET = 1 << 4,
91 7e7c5e4c balrog
    ONEN_INT_ERASE = 1 << 5,
92 7e7c5e4c balrog
    ONEN_INT_PROG = 1 << 6,
93 7e7c5e4c balrog
    ONEN_INT_LOAD = 1 << 7,
94 7e7c5e4c balrog
    ONEN_INT = 1 << 15,
95 7e7c5e4c balrog
};
96 7e7c5e4c balrog
97 7e7c5e4c balrog
enum {
98 7e7c5e4c balrog
    ONEN_LOCK_LOCKTIGHTEN = 1 << 0,
99 7e7c5e4c balrog
    ONEN_LOCK_LOCKED = 1 << 1,
100 7e7c5e4c balrog
    ONEN_LOCK_UNLOCKED = 1 << 2,
101 7e7c5e4c balrog
};
102 7e7c5e4c balrog
103 c227f099 Anthony Liguori
void onenand_base_update(void *opaque, target_phys_addr_t new)
104 7e7c5e4c balrog
{
105 bc24a225 Paul Brook
    OneNANDState *s = (OneNANDState *) opaque;
106 7e7c5e4c balrog
107 7e7c5e4c balrog
    s->base = new;
108 7e7c5e4c balrog
109 7e7c5e4c balrog
    /* XXX: We should use IO_MEM_ROMD but we broke it earlier...
110 7e7c5e4c balrog
     * Both 0x0000 ... 0x01ff and 0x8000 ... 0x800f can be used to
111 7e7c5e4c balrog
     * write boot commands.  Also take note of the BWPS bit.  */
112 7e7c5e4c balrog
    cpu_register_physical_memory(s->base + (0x0000 << s->shift),
113 7e7c5e4c balrog
                    0x0200 << s->shift, s->iomemtype);
114 7e7c5e4c balrog
    cpu_register_physical_memory(s->base + (0x0200 << s->shift),
115 7e7c5e4c balrog
                    0xbe00 << s->shift,
116 7e7c5e4c balrog
                    (s->ram +(0x0200 << s->shift)) | IO_MEM_RAM);
117 7e7c5e4c balrog
    if (s->iomemtype)
118 8da3ff18 pbrook
        cpu_register_physical_memory_offset(s->base + (0xc000 << s->shift),
119 8da3ff18 pbrook
                    0x4000 << s->shift, s->iomemtype, (0xc000 << s->shift));
120 7e7c5e4c balrog
}
121 7e7c5e4c balrog
122 7e7c5e4c balrog
void onenand_base_unmap(void *opaque)
123 7e7c5e4c balrog
{
124 bc24a225 Paul Brook
    OneNANDState *s = (OneNANDState *) opaque;
125 7e7c5e4c balrog
126 7e7c5e4c balrog
    cpu_register_physical_memory(s->base,
127 7e7c5e4c balrog
                    0x10000 << s->shift, IO_MEM_UNASSIGNED);
128 7e7c5e4c balrog
}
129 7e7c5e4c balrog
130 bc24a225 Paul Brook
static void onenand_intr_update(OneNANDState *s)
131 7e7c5e4c balrog
{
132 7e7c5e4c balrog
    qemu_set_irq(s->intr, ((s->intstatus >> 15) ^ (~s->config[0] >> 6)) & 1);
133 7e7c5e4c balrog
}
134 7e7c5e4c balrog
135 7e7c5e4c balrog
/* Hot reset (Reset OneNAND command) or warm reset (RP pin low) */
136 bc24a225 Paul Brook
static void onenand_reset(OneNANDState *s, int cold)
137 7e7c5e4c balrog
{
138 7e7c5e4c balrog
    memset(&s->addr, 0, sizeof(s->addr));
139 7e7c5e4c balrog
    s->command = 0;
140 7e7c5e4c balrog
    s->count = 1;
141 7e7c5e4c balrog
    s->bufaddr = 0;
142 7e7c5e4c balrog
    s->config[0] = 0x40c0;
143 7e7c5e4c balrog
    s->config[1] = 0x0000;
144 7e7c5e4c balrog
    onenand_intr_update(s);
145 7e7c5e4c balrog
    qemu_irq_raise(s->rdy);
146 7e7c5e4c balrog
    s->status = 0x0000;
147 7e7c5e4c balrog
    s->intstatus = cold ? 0x8080 : 0x8010;
148 7e7c5e4c balrog
    s->unladdr[0] = 0;
149 7e7c5e4c balrog
    s->unladdr[1] = 0;
150 7e7c5e4c balrog
    s->wpstatus = 0x0002;
151 7e7c5e4c balrog
    s->cycle = 0;
152 7e7c5e4c balrog
    s->otpmode = 0;
153 7e7c5e4c balrog
    s->bdrv_cur = s->bdrv;
154 7e7c5e4c balrog
    s->current = s->image;
155 7e7c5e4c balrog
    s->secs_cur = s->secs;
156 7e7c5e4c balrog
157 7e7c5e4c balrog
    if (cold) {
158 7e7c5e4c balrog
        /* Lock the whole flash */
159 7e7c5e4c balrog
        memset(s->blockwp, ONEN_LOCK_LOCKED, s->blocks);
160 7e7c5e4c balrog
161 7e7c5e4c balrog
        if (s->bdrv && bdrv_read(s->bdrv, 0, s->boot[0], 8) < 0)
162 2ac71179 Paul Brook
            hw_error("%s: Loading the BootRAM failed.\n", __FUNCTION__);
163 7e7c5e4c balrog
    }
164 7e7c5e4c balrog
}
165 7e7c5e4c balrog
166 bc24a225 Paul Brook
static inline int onenand_load_main(OneNANDState *s, int sec, int secn,
167 7e7c5e4c balrog
                void *dest)
168 7e7c5e4c balrog
{
169 7e7c5e4c balrog
    if (s->bdrv_cur)
170 7e7c5e4c balrog
        return bdrv_read(s->bdrv_cur, sec, dest, secn) < 0;
171 7e7c5e4c balrog
    else if (sec + secn > s->secs_cur)
172 7e7c5e4c balrog
        return 1;
173 7e7c5e4c balrog
174 7e7c5e4c balrog
    memcpy(dest, s->current + (sec << 9), secn << 9);
175 7e7c5e4c balrog
176 7e7c5e4c balrog
    return 0;
177 7e7c5e4c balrog
}
178 7e7c5e4c balrog
179 bc24a225 Paul Brook
static inline int onenand_prog_main(OneNANDState *s, int sec, int secn,
180 7e7c5e4c balrog
                void *src)
181 7e7c5e4c balrog
{
182 f1588dd2 Juha Riihimäki
    int result = 0;
183 f1588dd2 Juha Riihimäki
184 f1588dd2 Juha Riihimäki
    if (secn > 0) {
185 f1588dd2 Juha Riihimäki
        uint32_t size = (uint32_t) secn * 512;
186 f1588dd2 Juha Riihimäki
        const uint8_t *sp = (const uint8_t *) src;
187 f1588dd2 Juha Riihimäki
        uint8_t *dp = 0;
188 f1588dd2 Juha Riihimäki
        if (s->bdrv_cur) {
189 7267c094 Anthony Liguori
            dp = g_malloc(size);
190 f1588dd2 Juha Riihimäki
            if (!dp || bdrv_read(s->bdrv_cur, sec, dp, secn) < 0) {
191 f1588dd2 Juha Riihimäki
                result = 1;
192 f1588dd2 Juha Riihimäki
            }
193 f1588dd2 Juha Riihimäki
        } else {
194 f1588dd2 Juha Riihimäki
            if (sec + secn > s->secs_cur) {
195 f1588dd2 Juha Riihimäki
                result = 1;
196 f1588dd2 Juha Riihimäki
            } else {
197 f1588dd2 Juha Riihimäki
                dp = (uint8_t *) s->current + (sec << 9);
198 f1588dd2 Juha Riihimäki
            }
199 f1588dd2 Juha Riihimäki
        }
200 f1588dd2 Juha Riihimäki
        if (!result) {
201 f1588dd2 Juha Riihimäki
            uint32_t i;
202 f1588dd2 Juha Riihimäki
            for (i = 0; i < size; i++) {
203 f1588dd2 Juha Riihimäki
                dp[i] &= sp[i];
204 f1588dd2 Juha Riihimäki
            }
205 f1588dd2 Juha Riihimäki
            if (s->bdrv_cur) {
206 f1588dd2 Juha Riihimäki
                result = bdrv_write(s->bdrv_cur, sec, dp, secn) < 0;
207 f1588dd2 Juha Riihimäki
            }
208 f1588dd2 Juha Riihimäki
        }
209 f1588dd2 Juha Riihimäki
        if (dp && s->bdrv_cur) {
210 7267c094 Anthony Liguori
            g_free(dp);
211 f1588dd2 Juha Riihimäki
        }
212 f1588dd2 Juha Riihimäki
    }
213 7e7c5e4c balrog
214 f1588dd2 Juha Riihimäki
    return result;
215 7e7c5e4c balrog
}
216 7e7c5e4c balrog
217 bc24a225 Paul Brook
static inline int onenand_load_spare(OneNANDState *s, int sec, int secn,
218 7e7c5e4c balrog
                void *dest)
219 7e7c5e4c balrog
{
220 7e7c5e4c balrog
    uint8_t buf[512];
221 7e7c5e4c balrog
222 7e7c5e4c balrog
    if (s->bdrv_cur) {
223 7e7c5e4c balrog
        if (bdrv_read(s->bdrv_cur, s->secs_cur + (sec >> 5), buf, 1) < 0)
224 7e7c5e4c balrog
            return 1;
225 7e7c5e4c balrog
        memcpy(dest, buf + ((sec & 31) << 4), secn << 4);
226 7e7c5e4c balrog
    } else if (sec + secn > s->secs_cur)
227 7e7c5e4c balrog
        return 1;
228 7e7c5e4c balrog
    else
229 7e7c5e4c balrog
        memcpy(dest, s->current + (s->secs_cur << 9) + (sec << 4), secn << 4);
230 7e7c5e4c balrog
 
231 7e7c5e4c balrog
    return 0;
232 7e7c5e4c balrog
}
233 7e7c5e4c balrog
234 bc24a225 Paul Brook
static inline int onenand_prog_spare(OneNANDState *s, int sec, int secn,
235 7e7c5e4c balrog
                void *src)
236 7e7c5e4c balrog
{
237 f1588dd2 Juha Riihimäki
    int result = 0;
238 f1588dd2 Juha Riihimäki
    if (secn > 0) {
239 f1588dd2 Juha Riihimäki
        const uint8_t *sp = (const uint8_t *) src;
240 f1588dd2 Juha Riihimäki
        uint8_t *dp = 0, *dpp = 0;
241 f1588dd2 Juha Riihimäki
        if (s->bdrv_cur) {
242 7267c094 Anthony Liguori
            dp = g_malloc(512);
243 f1588dd2 Juha Riihimäki
            if (!dp || bdrv_read(s->bdrv_cur,
244 f1588dd2 Juha Riihimäki
                                s->secs_cur + (sec >> 5),
245 f1588dd2 Juha Riihimäki
                                dp, 1) < 0) {
246 f1588dd2 Juha Riihimäki
                result = 1;
247 f1588dd2 Juha Riihimäki
            } else {
248 f1588dd2 Juha Riihimäki
                dpp = dp + ((sec & 31) << 4);
249 f1588dd2 Juha Riihimäki
            }
250 f1588dd2 Juha Riihimäki
        } else {
251 f1588dd2 Juha Riihimäki
            if (sec + secn > s->secs_cur) {
252 f1588dd2 Juha Riihimäki
                result = 1;
253 f1588dd2 Juha Riihimäki
            } else {
254 f1588dd2 Juha Riihimäki
                dpp = s->current + (s->secs_cur << 9) + (sec << 4);
255 f1588dd2 Juha Riihimäki
            }
256 f1588dd2 Juha Riihimäki
        }
257 f1588dd2 Juha Riihimäki
        if (!result) {
258 f1588dd2 Juha Riihimäki
            uint32_t i;
259 f1588dd2 Juha Riihimäki
            for (i = 0; i < (secn << 4); i++) {
260 f1588dd2 Juha Riihimäki
                dpp[i] &= sp[i];
261 f1588dd2 Juha Riihimäki
            }
262 f1588dd2 Juha Riihimäki
            if (s->bdrv_cur) {
263 f1588dd2 Juha Riihimäki
                result = bdrv_write(s->bdrv_cur, s->secs_cur + (sec >> 5),
264 f1588dd2 Juha Riihimäki
                                dp, 1) < 0;
265 f1588dd2 Juha Riihimäki
            }
266 f1588dd2 Juha Riihimäki
        }
267 f1588dd2 Juha Riihimäki
        if (dp) {
268 7267c094 Anthony Liguori
            g_free(dp);
269 f1588dd2 Juha Riihimäki
        }
270 f1588dd2 Juha Riihimäki
    }
271 f1588dd2 Juha Riihimäki
    return result;
272 7e7c5e4c balrog
}
273 7e7c5e4c balrog
274 bc24a225 Paul Brook
static inline int onenand_erase(OneNANDState *s, int sec, int num)
275 7e7c5e4c balrog
{
276 f1588dd2 Juha Riihimäki
    uint8_t *blankbuf, *tmpbuf;
277 7267c094 Anthony Liguori
    blankbuf = g_malloc(512);
278 f1588dd2 Juha Riihimäki
    if (!blankbuf) {
279 f1588dd2 Juha Riihimäki
        return 1;
280 f1588dd2 Juha Riihimäki
    }
281 7267c094 Anthony Liguori
    tmpbuf = g_malloc(512);
282 f1588dd2 Juha Riihimäki
    if (!tmpbuf) {
283 7267c094 Anthony Liguori
        g_free(blankbuf);
284 f1588dd2 Juha Riihimäki
        return 1;
285 f1588dd2 Juha Riihimäki
    }
286 f1588dd2 Juha Riihimäki
    memset(blankbuf, 0xff, 512);
287 f1588dd2 Juha Riihimäki
    for (; num > 0; num--, sec++) {
288 f1588dd2 Juha Riihimäki
        if (s->bdrv_cur) {
289 f1588dd2 Juha Riihimäki
            int erasesec = s->secs_cur + (sec >> 5);
290 f1588dd2 Juha Riihimäki
            if (bdrv_write(s->bdrv_cur, sec, blankbuf, 1)) {
291 f1588dd2 Juha Riihimäki
                goto fail;
292 f1588dd2 Juha Riihimäki
            }
293 f1588dd2 Juha Riihimäki
            if (bdrv_read(s->bdrv_cur, erasesec, tmpbuf, 1) < 0) {
294 f1588dd2 Juha Riihimäki
                goto fail;
295 f1588dd2 Juha Riihimäki
            }
296 f1588dd2 Juha Riihimäki
            memcpy(tmpbuf + ((sec & 31) << 4), blankbuf, 1 << 4);
297 f1588dd2 Juha Riihimäki
            if (bdrv_write(s->bdrv_cur, erasesec, tmpbuf, 1) < 0) {
298 f1588dd2 Juha Riihimäki
                goto fail;
299 f1588dd2 Juha Riihimäki
            }
300 f1588dd2 Juha Riihimäki
        } else {
301 f1588dd2 Juha Riihimäki
            if (sec + 1 > s->secs_cur) {
302 f1588dd2 Juha Riihimäki
                goto fail;
303 f1588dd2 Juha Riihimäki
            }
304 f1588dd2 Juha Riihimäki
            memcpy(s->current + (sec << 9), blankbuf, 512);
305 f1588dd2 Juha Riihimäki
            memcpy(s->current + (s->secs_cur << 9) + (sec << 4),
306 f1588dd2 Juha Riihimäki
                   blankbuf, 1 << 4);
307 f1588dd2 Juha Riihimäki
        }
308 7e7c5e4c balrog
    }
309 7e7c5e4c balrog
310 7267c094 Anthony Liguori
    g_free(tmpbuf);
311 7267c094 Anthony Liguori
    g_free(blankbuf);
312 7e7c5e4c balrog
    return 0;
313 f1588dd2 Juha Riihimäki
314 f1588dd2 Juha Riihimäki
fail:
315 7267c094 Anthony Liguori
    g_free(tmpbuf);
316 7267c094 Anthony Liguori
    g_free(blankbuf);
317 f1588dd2 Juha Riihimäki
    return 1;
318 7e7c5e4c balrog
}
319 7e7c5e4c balrog
320 bc24a225 Paul Brook
static void onenand_command(OneNANDState *s, int cmd)
321 7e7c5e4c balrog
{
322 7e7c5e4c balrog
    int b;
323 7e7c5e4c balrog
    int sec;
324 7e7c5e4c balrog
    void *buf;
325 7e7c5e4c balrog
#define SETADDR(block, page)                        \
326 7e7c5e4c balrog
    sec = (s->addr[page] & 3) +                        \
327 7e7c5e4c balrog
            ((((s->addr[page] >> 2) & 0x3f) +        \
328 7e7c5e4c balrog
              (((s->addr[block] & 0xfff) |        \
329 7e7c5e4c balrog
                (s->addr[block] >> 15 ?                \
330 7e7c5e4c balrog
                 s->density_mask : 0)) << 6)) << (PAGE_SHIFT - 9));
331 7e7c5e4c balrog
#define SETBUF_M()                                \
332 7e7c5e4c balrog
    buf = (s->bufaddr & 8) ?                        \
333 7e7c5e4c balrog
            s->data[(s->bufaddr >> 2) & 1][0] : s->boot[0];        \
334 7e7c5e4c balrog
    buf += (s->bufaddr & 3) << 9;
335 7e7c5e4c balrog
#define SETBUF_S()                                \
336 7e7c5e4c balrog
    buf = (s->bufaddr & 8) ?                        \
337 7e7c5e4c balrog
            s->data[(s->bufaddr >> 2) & 1][1] : s->boot[1];        \
338 7e7c5e4c balrog
    buf += (s->bufaddr & 3) << 4;
339 7e7c5e4c balrog
340 7e7c5e4c balrog
    switch (cmd) {
341 7e7c5e4c balrog
    case 0x00:        /* Load single/multiple sector data unit into buffer */
342 7e7c5e4c balrog
        SETADDR(ONEN_BUF_BLOCK, ONEN_BUF_PAGE)
343 7e7c5e4c balrog
344 7e7c5e4c balrog
        SETBUF_M()
345 7e7c5e4c balrog
        if (onenand_load_main(s, sec, s->count, buf))
346 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_LOAD;
347 7e7c5e4c balrog
348 7e7c5e4c balrog
#if 0
349 7e7c5e4c balrog
        SETBUF_S()
350 7e7c5e4c balrog
        if (onenand_load_spare(s, sec, s->count, buf))
351 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_LOAD;
352 7e7c5e4c balrog
#endif
353 7e7c5e4c balrog
354 7e7c5e4c balrog
        /* TODO: if (s->bufaddr & 3) + s->count was > 4 (2k-pages)
355 7e7c5e4c balrog
         * or    if (s->bufaddr & 1) + s->count was > 2 (1k-pages)
356 7e7c5e4c balrog
         * then we need two split the read/write into two chunks.
357 7e7c5e4c balrog
         */
358 7e7c5e4c balrog
        s->intstatus |= ONEN_INT | ONEN_INT_LOAD;
359 7e7c5e4c balrog
        break;
360 7e7c5e4c balrog
    case 0x13:        /* Load single/multiple spare sector into buffer */
361 7e7c5e4c balrog
        SETADDR(ONEN_BUF_BLOCK, ONEN_BUF_PAGE)
362 7e7c5e4c balrog
363 7e7c5e4c balrog
        SETBUF_S()
364 7e7c5e4c balrog
        if (onenand_load_spare(s, sec, s->count, buf))
365 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_LOAD;
366 7e7c5e4c balrog
367 7e7c5e4c balrog
        /* TODO: if (s->bufaddr & 3) + s->count was > 4 (2k-pages)
368 7e7c5e4c balrog
         * or    if (s->bufaddr & 1) + s->count was > 2 (1k-pages)
369 7e7c5e4c balrog
         * then we need two split the read/write into two chunks.
370 7e7c5e4c balrog
         */
371 7e7c5e4c balrog
        s->intstatus |= ONEN_INT | ONEN_INT_LOAD;
372 7e7c5e4c balrog
        break;
373 7e7c5e4c balrog
    case 0x80:        /* Program single/multiple sector data unit from buffer */
374 7e7c5e4c balrog
        SETADDR(ONEN_BUF_BLOCK, ONEN_BUF_PAGE)
375 7e7c5e4c balrog
376 7e7c5e4c balrog
        SETBUF_M()
377 7e7c5e4c balrog
        if (onenand_prog_main(s, sec, s->count, buf))
378 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_PROG;
379 7e7c5e4c balrog
380 7e7c5e4c balrog
#if 0
381 7e7c5e4c balrog
        SETBUF_S()
382 7e7c5e4c balrog
        if (onenand_prog_spare(s, sec, s->count, buf))
383 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_PROG;
384 7e7c5e4c balrog
#endif
385 7e7c5e4c balrog
386 7e7c5e4c balrog
        /* TODO: if (s->bufaddr & 3) + s->count was > 4 (2k-pages)
387 7e7c5e4c balrog
         * or    if (s->bufaddr & 1) + s->count was > 2 (1k-pages)
388 7e7c5e4c balrog
         * then we need two split the read/write into two chunks.
389 7e7c5e4c balrog
         */
390 7e7c5e4c balrog
        s->intstatus |= ONEN_INT | ONEN_INT_PROG;
391 7e7c5e4c balrog
        break;
392 7e7c5e4c balrog
    case 0x1a:        /* Program single/multiple spare area sector from buffer */
393 7e7c5e4c balrog
        SETADDR(ONEN_BUF_BLOCK, ONEN_BUF_PAGE)
394 7e7c5e4c balrog
395 7e7c5e4c balrog
        SETBUF_S()
396 7e7c5e4c balrog
        if (onenand_prog_spare(s, sec, s->count, buf))
397 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_PROG;
398 7e7c5e4c balrog
399 7e7c5e4c balrog
        /* TODO: if (s->bufaddr & 3) + s->count was > 4 (2k-pages)
400 7e7c5e4c balrog
         * or    if (s->bufaddr & 1) + s->count was > 2 (1k-pages)
401 7e7c5e4c balrog
         * then we need two split the read/write into two chunks.
402 7e7c5e4c balrog
         */
403 7e7c5e4c balrog
        s->intstatus |= ONEN_INT | ONEN_INT_PROG;
404 7e7c5e4c balrog
        break;
405 7e7c5e4c balrog
    case 0x1b:        /* Copy-back program */
406 7e7c5e4c balrog
        SETBUF_S()
407 7e7c5e4c balrog
408 7e7c5e4c balrog
        SETADDR(ONEN_BUF_BLOCK, ONEN_BUF_PAGE)
409 7e7c5e4c balrog
        if (onenand_load_main(s, sec, s->count, buf))
410 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_PROG;
411 7e7c5e4c balrog
412 7e7c5e4c balrog
        SETADDR(ONEN_BUF_DEST_BLOCK, ONEN_BUF_DEST_PAGE)
413 7e7c5e4c balrog
        if (onenand_prog_main(s, sec, s->count, buf))
414 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_PROG;
415 7e7c5e4c balrog
416 7e7c5e4c balrog
        /* TODO: spare areas */
417 7e7c5e4c balrog
418 7e7c5e4c balrog
        s->intstatus |= ONEN_INT | ONEN_INT_PROG;
419 7e7c5e4c balrog
        break;
420 7e7c5e4c balrog
421 7e7c5e4c balrog
    case 0x23:        /* Unlock NAND array block(s) */
422 7e7c5e4c balrog
        s->intstatus |= ONEN_INT;
423 7e7c5e4c balrog
424 7e7c5e4c balrog
        /* XXX the previous (?) area should be locked automatically */
425 7e7c5e4c balrog
        for (b = s->unladdr[0]; b <= s->unladdr[1]; b ++) {
426 7e7c5e4c balrog
            if (b >= s->blocks) {
427 7e7c5e4c balrog
                s->status |= ONEN_ERR_CMD;
428 7e7c5e4c balrog
                break;
429 7e7c5e4c balrog
            }
430 7e7c5e4c balrog
            if (s->blockwp[b] == ONEN_LOCK_LOCKTIGHTEN)
431 7e7c5e4c balrog
                break;
432 7e7c5e4c balrog
433 7e7c5e4c balrog
            s->wpstatus = s->blockwp[b] = ONEN_LOCK_UNLOCKED;
434 7e7c5e4c balrog
        }
435 7e7c5e4c balrog
        break;
436 89588a4b balrog
    case 0x27:        /* Unlock All NAND array blocks */
437 89588a4b balrog
        s->intstatus |= ONEN_INT;
438 89588a4b balrog
439 89588a4b balrog
        for (b = 0; b < s->blocks; b ++) {
440 89588a4b balrog
            if (b >= s->blocks) {
441 89588a4b balrog
                s->status |= ONEN_ERR_CMD;
442 89588a4b balrog
                break;
443 89588a4b balrog
            }
444 89588a4b balrog
            if (s->blockwp[b] == ONEN_LOCK_LOCKTIGHTEN)
445 89588a4b balrog
                break;
446 89588a4b balrog
447 89588a4b balrog
            s->wpstatus = s->blockwp[b] = ONEN_LOCK_UNLOCKED;
448 89588a4b balrog
        }
449 89588a4b balrog
        break;
450 89588a4b balrog
451 7e7c5e4c balrog
    case 0x2a:        /* Lock NAND array block(s) */
452 7e7c5e4c balrog
        s->intstatus |= ONEN_INT;
453 7e7c5e4c balrog
454 7e7c5e4c balrog
        for (b = s->unladdr[0]; b <= s->unladdr[1]; b ++) {
455 7e7c5e4c balrog
            if (b >= s->blocks) {
456 7e7c5e4c balrog
                s->status |= ONEN_ERR_CMD;
457 7e7c5e4c balrog
                break;
458 7e7c5e4c balrog
            }
459 7e7c5e4c balrog
            if (s->blockwp[b] == ONEN_LOCK_LOCKTIGHTEN)
460 7e7c5e4c balrog
                break;
461 7e7c5e4c balrog
462 7e7c5e4c balrog
            s->wpstatus = s->blockwp[b] = ONEN_LOCK_LOCKED;
463 7e7c5e4c balrog
        }
464 7e7c5e4c balrog
        break;
465 7e7c5e4c balrog
    case 0x2c:        /* Lock-tight NAND array block(s) */
466 7e7c5e4c balrog
        s->intstatus |= ONEN_INT;
467 7e7c5e4c balrog
468 7e7c5e4c balrog
        for (b = s->unladdr[0]; b <= s->unladdr[1]; b ++) {
469 7e7c5e4c balrog
            if (b >= s->blocks) {
470 7e7c5e4c balrog
                s->status |= ONEN_ERR_CMD;
471 7e7c5e4c balrog
                break;
472 7e7c5e4c balrog
            }
473 7e7c5e4c balrog
            if (s->blockwp[b] == ONEN_LOCK_UNLOCKED)
474 7e7c5e4c balrog
                continue;
475 7e7c5e4c balrog
476 7e7c5e4c balrog
            s->wpstatus = s->blockwp[b] = ONEN_LOCK_LOCKTIGHTEN;
477 7e7c5e4c balrog
        }
478 7e7c5e4c balrog
        break;
479 7e7c5e4c balrog
480 7e7c5e4c balrog
    case 0x71:        /* Erase-Verify-Read */
481 7e7c5e4c balrog
        s->intstatus |= ONEN_INT;
482 7e7c5e4c balrog
        break;
483 7e7c5e4c balrog
    case 0x95:        /* Multi-block erase */
484 7e7c5e4c balrog
        qemu_irq_pulse(s->intr);
485 7e7c5e4c balrog
        /* Fall through.  */
486 7e7c5e4c balrog
    case 0x94:        /* Block erase */
487 7e7c5e4c balrog
        sec = ((s->addr[ONEN_BUF_BLOCK] & 0xfff) |
488 7e7c5e4c balrog
                        (s->addr[ONEN_BUF_BLOCK] >> 15 ? s->density_mask : 0))
489 7e7c5e4c balrog
                << (BLOCK_SHIFT - 9);
490 7e7c5e4c balrog
        if (onenand_erase(s, sec, 1 << (BLOCK_SHIFT - 9)))
491 7e7c5e4c balrog
            s->status |= ONEN_ERR_CMD | ONEN_ERR_ERASE;
492 7e7c5e4c balrog
493 7e7c5e4c balrog
        s->intstatus |= ONEN_INT | ONEN_INT_ERASE;
494 7e7c5e4c balrog
        break;
495 7e7c5e4c balrog
    case 0xb0:        /* Erase suspend */
496 7e7c5e4c balrog
        break;
497 7e7c5e4c balrog
    case 0x30:        /* Erase resume */
498 7e7c5e4c balrog
        s->intstatus |= ONEN_INT | ONEN_INT_ERASE;
499 7e7c5e4c balrog
        break;
500 7e7c5e4c balrog
501 7e7c5e4c balrog
    case 0xf0:        /* Reset NAND Flash core */
502 7e7c5e4c balrog
        onenand_reset(s, 0);
503 7e7c5e4c balrog
        break;
504 7e7c5e4c balrog
    case 0xf3:        /* Reset OneNAND */
505 7e7c5e4c balrog
        onenand_reset(s, 0);
506 7e7c5e4c balrog
        break;
507 7e7c5e4c balrog
508 7e7c5e4c balrog
    case 0x65:        /* OTP Access */
509 7e7c5e4c balrog
        s->intstatus |= ONEN_INT;
510 b9d38e95 Blue Swirl
        s->bdrv_cur = NULL;
511 7e7c5e4c balrog
        s->current = s->otp;
512 7e7c5e4c balrog
        s->secs_cur = 1 << (BLOCK_SHIFT - 9);
513 7e7c5e4c balrog
        s->addr[ONEN_BUF_BLOCK] = 0;
514 7e7c5e4c balrog
        s->otpmode = 1;
515 7e7c5e4c balrog
        break;
516 7e7c5e4c balrog
517 7e7c5e4c balrog
    default:
518 7e7c5e4c balrog
        s->status |= ONEN_ERR_CMD;
519 7e7c5e4c balrog
        s->intstatus |= ONEN_INT;
520 7e7c5e4c balrog
        fprintf(stderr, "%s: unknown OneNAND command %x\n",
521 7e7c5e4c balrog
                        __FUNCTION__, cmd);
522 7e7c5e4c balrog
    }
523 7e7c5e4c balrog
524 7e7c5e4c balrog
    onenand_intr_update(s);
525 7e7c5e4c balrog
}
526 7e7c5e4c balrog
527 c227f099 Anthony Liguori
static uint32_t onenand_read(void *opaque, target_phys_addr_t addr)
528 7e7c5e4c balrog
{
529 bc24a225 Paul Brook
    OneNANDState *s = (OneNANDState *) opaque;
530 8da3ff18 pbrook
    int offset = addr >> s->shift;
531 7e7c5e4c balrog
532 7e7c5e4c balrog
    switch (offset) {
533 7e7c5e4c balrog
    case 0x0000 ... 0xc000:
534 8da3ff18 pbrook
        return lduw_le_p(s->boot[0] + addr);
535 7e7c5e4c balrog
536 7e7c5e4c balrog
    case 0xf000:        /* Manufacturer ID */
537 5923ba42 Juha Riihimäki
        return s->id.man;
538 7e7c5e4c balrog
    case 0xf001:        /* Device ID */
539 5923ba42 Juha Riihimäki
        return s->id.dev;
540 7e7c5e4c balrog
    case 0xf002:        /* Version ID */
541 5923ba42 Juha Riihimäki
        return s->id.ver;
542 5923ba42 Juha Riihimäki
    /* TODO: get the following values from a real chip!  */
543 7e7c5e4c balrog
    case 0xf003:        /* Data Buffer size */
544 7e7c5e4c balrog
        return 1 << PAGE_SHIFT;
545 7e7c5e4c balrog
    case 0xf004:        /* Boot Buffer size */
546 7e7c5e4c balrog
        return 0x200;
547 7e7c5e4c balrog
    case 0xf005:        /* Amount of buffers */
548 7e7c5e4c balrog
        return 1 | (2 << 8);
549 7e7c5e4c balrog
    case 0xf006:        /* Technology */
550 7e7c5e4c balrog
        return 0;
551 7e7c5e4c balrog
552 7e7c5e4c balrog
    case 0xf100 ... 0xf107:        /* Start addresses */
553 7e7c5e4c balrog
        return s->addr[offset - 0xf100];
554 7e7c5e4c balrog
555 7e7c5e4c balrog
    case 0xf200:        /* Start buffer */
556 7e7c5e4c balrog
        return (s->bufaddr << 8) | ((s->count - 1) & (1 << (PAGE_SHIFT - 10)));
557 7e7c5e4c balrog
558 7e7c5e4c balrog
    case 0xf220:        /* Command */
559 7e7c5e4c balrog
        return s->command;
560 7e7c5e4c balrog
    case 0xf221:        /* System Configuration 1 */
561 7e7c5e4c balrog
        return s->config[0] & 0xffe0;
562 7e7c5e4c balrog
    case 0xf222:        /* System Configuration 2 */
563 7e7c5e4c balrog
        return s->config[1];
564 7e7c5e4c balrog
565 7e7c5e4c balrog
    case 0xf240:        /* Controller Status */
566 7e7c5e4c balrog
        return s->status;
567 7e7c5e4c balrog
    case 0xf241:        /* Interrupt */
568 7e7c5e4c balrog
        return s->intstatus;
569 7e7c5e4c balrog
    case 0xf24c:        /* Unlock Start Block Address */
570 7e7c5e4c balrog
        return s->unladdr[0];
571 7e7c5e4c balrog
    case 0xf24d:        /* Unlock End Block Address */
572 7e7c5e4c balrog
        return s->unladdr[1];
573 7e7c5e4c balrog
    case 0xf24e:        /* Write Protection Status */
574 7e7c5e4c balrog
        return s->wpstatus;
575 7e7c5e4c balrog
576 7e7c5e4c balrog
    case 0xff00:        /* ECC Status */
577 7e7c5e4c balrog
        return 0x00;
578 7e7c5e4c balrog
    case 0xff01:        /* ECC Result of main area data */
579 7e7c5e4c balrog
    case 0xff02:        /* ECC Result of spare area data */
580 7e7c5e4c balrog
    case 0xff03:        /* ECC Result of main area data */
581 7e7c5e4c balrog
    case 0xff04:        /* ECC Result of spare area data */
582 2ac71179 Paul Brook
        hw_error("%s: imeplement ECC\n", __FUNCTION__);
583 7e7c5e4c balrog
        return 0x0000;
584 7e7c5e4c balrog
    }
585 7e7c5e4c balrog
586 7e7c5e4c balrog
    fprintf(stderr, "%s: unknown OneNAND register %x\n",
587 7e7c5e4c balrog
                    __FUNCTION__, offset);
588 7e7c5e4c balrog
    return 0;
589 7e7c5e4c balrog
}
590 7e7c5e4c balrog
591 c227f099 Anthony Liguori
static void onenand_write(void *opaque, target_phys_addr_t addr,
592 7e7c5e4c balrog
                uint32_t value)
593 7e7c5e4c balrog
{
594 bc24a225 Paul Brook
    OneNANDState *s = (OneNANDState *) opaque;
595 8da3ff18 pbrook
    int offset = addr >> s->shift;
596 7e7c5e4c balrog
    int sec;
597 7e7c5e4c balrog
598 7e7c5e4c balrog
    switch (offset) {
599 7e7c5e4c balrog
    case 0x0000 ... 0x01ff:
600 7e7c5e4c balrog
    case 0x8000 ... 0x800f:
601 7e7c5e4c balrog
        if (s->cycle) {
602 7e7c5e4c balrog
            s->cycle = 0;
603 7e7c5e4c balrog
604 7e7c5e4c balrog
            if (value == 0x0000) {
605 7e7c5e4c balrog
                SETADDR(ONEN_BUF_BLOCK, ONEN_BUF_PAGE)
606 7e7c5e4c balrog
                onenand_load_main(s, sec,
607 7e7c5e4c balrog
                                1 << (PAGE_SHIFT - 9), s->data[0][0]);
608 7e7c5e4c balrog
                s->addr[ONEN_BUF_PAGE] += 4;
609 7e7c5e4c balrog
                s->addr[ONEN_BUF_PAGE] &= 0xff;
610 7e7c5e4c balrog
            }
611 7e7c5e4c balrog
            break;
612 7e7c5e4c balrog
        }
613 7e7c5e4c balrog
614 7e7c5e4c balrog
        switch (value) {
615 7e7c5e4c balrog
        case 0x00f0:        /* Reset OneNAND */
616 7e7c5e4c balrog
            onenand_reset(s, 0);
617 7e7c5e4c balrog
            break;
618 7e7c5e4c balrog
619 7e7c5e4c balrog
        case 0x00e0:        /* Load Data into Buffer */
620 7e7c5e4c balrog
            s->cycle = 1;
621 7e7c5e4c balrog
            break;
622 7e7c5e4c balrog
623 7e7c5e4c balrog
        case 0x0090:        /* Read Identification Data */
624 7e7c5e4c balrog
            memset(s->boot[0], 0, 3 << s->shift);
625 5923ba42 Juha Riihimäki
            s->boot[0][0 << s->shift] = s->id.man & 0xff;
626 5923ba42 Juha Riihimäki
            s->boot[0][1 << s->shift] = s->id.dev & 0xff;
627 7e7c5e4c balrog
            s->boot[0][2 << s->shift] = s->wpstatus & 0xff;
628 7e7c5e4c balrog
            break;
629 7e7c5e4c balrog
630 7e7c5e4c balrog
        default:
631 7e7c5e4c balrog
            fprintf(stderr, "%s: unknown OneNAND boot command %x\n",
632 7e7c5e4c balrog
                            __FUNCTION__, value);
633 7e7c5e4c balrog
        }
634 7e7c5e4c balrog
        break;
635 7e7c5e4c balrog
636 7e7c5e4c balrog
    case 0xf100 ... 0xf107:        /* Start addresses */
637 7e7c5e4c balrog
        s->addr[offset - 0xf100] = value;
638 7e7c5e4c balrog
        break;
639 7e7c5e4c balrog
640 7e7c5e4c balrog
    case 0xf200:        /* Start buffer */
641 7e7c5e4c balrog
        s->bufaddr = (value >> 8) & 0xf;
642 7e7c5e4c balrog
        if (PAGE_SHIFT == 11)
643 7e7c5e4c balrog
            s->count = (value & 3) ?: 4;
644 7e7c5e4c balrog
        else if (PAGE_SHIFT == 10)
645 7e7c5e4c balrog
            s->count = (value & 1) ?: 2;
646 7e7c5e4c balrog
        break;
647 7e7c5e4c balrog
648 7e7c5e4c balrog
    case 0xf220:        /* Command */
649 7e7c5e4c balrog
        if (s->intstatus & (1 << 15))
650 7e7c5e4c balrog
            break;
651 7e7c5e4c balrog
        s->command = value;
652 7e7c5e4c balrog
        onenand_command(s, s->command);
653 7e7c5e4c balrog
        break;
654 7e7c5e4c balrog
    case 0xf221:        /* System Configuration 1 */
655 7e7c5e4c balrog
        s->config[0] = value;
656 7e7c5e4c balrog
        onenand_intr_update(s);
657 7e7c5e4c balrog
        qemu_set_irq(s->rdy, (s->config[0] >> 7) & 1);
658 7e7c5e4c balrog
        break;
659 7e7c5e4c balrog
    case 0xf222:        /* System Configuration 2 */
660 7e7c5e4c balrog
        s->config[1] = value;
661 7e7c5e4c balrog
        break;
662 7e7c5e4c balrog
663 7e7c5e4c balrog
    case 0xf241:        /* Interrupt */
664 7e7c5e4c balrog
        s->intstatus &= value;
665 7e7c5e4c balrog
        if ((1 << 15) & ~s->intstatus)
666 7e7c5e4c balrog
            s->status &= ~(ONEN_ERR_CMD | ONEN_ERR_ERASE |
667 7e7c5e4c balrog
                            ONEN_ERR_PROG | ONEN_ERR_LOAD);
668 7e7c5e4c balrog
        onenand_intr_update(s);
669 7e7c5e4c balrog
        break;
670 7e7c5e4c balrog
    case 0xf24c:        /* Unlock Start Block Address */
671 7e7c5e4c balrog
        s->unladdr[0] = value & (s->blocks - 1);
672 7e7c5e4c balrog
        /* For some reason we have to set the end address to by default
673 7e7c5e4c balrog
         * be same as start because the software forgets to write anything
674 7e7c5e4c balrog
         * in there.  */
675 7e7c5e4c balrog
        s->unladdr[1] = value & (s->blocks - 1);
676 7e7c5e4c balrog
        break;
677 7e7c5e4c balrog
    case 0xf24d:        /* Unlock End Block Address */
678 7e7c5e4c balrog
        s->unladdr[1] = value & (s->blocks - 1);
679 7e7c5e4c balrog
        break;
680 7e7c5e4c balrog
681 7e7c5e4c balrog
    default:
682 7e7c5e4c balrog
        fprintf(stderr, "%s: unknown OneNAND register %x\n",
683 7e7c5e4c balrog
                        __FUNCTION__, offset);
684 7e7c5e4c balrog
    }
685 7e7c5e4c balrog
}
686 7e7c5e4c balrog
687 d60efc6b Blue Swirl
static CPUReadMemoryFunc * const onenand_readfn[] = {
688 7e7c5e4c balrog
    onenand_read,        /* TODO */
689 7e7c5e4c balrog
    onenand_read,
690 7e7c5e4c balrog
    onenand_read,
691 7e7c5e4c balrog
};
692 7e7c5e4c balrog
693 d60efc6b Blue Swirl
static CPUWriteMemoryFunc * const onenand_writefn[] = {
694 7e7c5e4c balrog
    onenand_write,        /* TODO */
695 7e7c5e4c balrog
    onenand_write,
696 7e7c5e4c balrog
    onenand_write,
697 7e7c5e4c balrog
};
698 7e7c5e4c balrog
699 5923ba42 Juha Riihimäki
void *onenand_init(BlockDriverState *bdrv,
700 5923ba42 Juha Riihimäki
                uint16_t man_id, uint16_t dev_id, uint16_t ver_id,
701 af5a75f4 Peter Maydell
                int regshift, qemu_irq irq)
702 7e7c5e4c balrog
{
703 7267c094 Anthony Liguori
    OneNANDState *s = (OneNANDState *) g_malloc0(sizeof(*s));
704 5923ba42 Juha Riihimäki
    uint32_t size = 1 << (24 + ((dev_id >> 4) & 7));
705 7e7c5e4c balrog
    void *ram;
706 7e7c5e4c balrog
707 7e7c5e4c balrog
    s->shift = regshift;
708 7e7c5e4c balrog
    s->intr = irq;
709 b9d38e95 Blue Swirl
    s->rdy = NULL;
710 5923ba42 Juha Riihimäki
    s->id.man = man_id;
711 5923ba42 Juha Riihimäki
    s->id.dev = dev_id;
712 5923ba42 Juha Riihimäki
    s->id.ver = ver_id;
713 7e7c5e4c balrog
    s->blocks = size >> BLOCK_SHIFT;
714 7e7c5e4c balrog
    s->secs = size >> 9;
715 7267c094 Anthony Liguori
    s->blockwp = g_malloc(s->blocks);
716 5923ba42 Juha Riihimäki
    s->density_mask = (dev_id & 0x08) ? (1 << (6 + ((dev_id >> 4) & 7))) : 0;
717 1eed09cb Avi Kivity
    s->iomemtype = cpu_register_io_memory(onenand_readfn,
718 2507c12a Alexander Graf
                    onenand_writefn, s, DEVICE_NATIVE_ENDIAN);
719 af5a75f4 Peter Maydell
    s->bdrv = bdrv;
720 af5a75f4 Peter Maydell
    if (!s->bdrv) {
721 7267c094 Anthony Liguori
        s->image = memset(g_malloc(size + (size >> 5)),
722 7e7c5e4c balrog
                        0xff, size + (size >> 5));
723 63efb1d9 Andrzej Zaborowski
    }
724 7267c094 Anthony Liguori
    s->otp = memset(g_malloc((64 + 2) << PAGE_SHIFT),
725 7e7c5e4c balrog
                    0xff, (64 + 2) << PAGE_SHIFT);
726 1724f049 Alex Williamson
    s->ram = qemu_ram_alloc(NULL, "onenand.ram", 0xc000 << s->shift);
727 5c130f65 pbrook
    ram = qemu_get_ram_ptr(s->ram);
728 7e7c5e4c balrog
    s->boot[0] = ram + (0x0000 << s->shift);
729 7e7c5e4c balrog
    s->boot[1] = ram + (0x8000 << s->shift);
730 7e7c5e4c balrog
    s->data[0][0] = ram + ((0x0200 + (0 << (PAGE_SHIFT - 1))) << s->shift);
731 7e7c5e4c balrog
    s->data[0][1] = ram + ((0x8010 + (0 << (PAGE_SHIFT - 6))) << s->shift);
732 7e7c5e4c balrog
    s->data[1][0] = ram + ((0x0200 + (1 << (PAGE_SHIFT - 1))) << s->shift);
733 7e7c5e4c balrog
    s->data[1][1] = ram + ((0x8010 + (1 << (PAGE_SHIFT - 6))) << s->shift);
734 7e7c5e4c balrog
735 7e7c5e4c balrog
    onenand_reset(s, 1);
736 7e7c5e4c balrog
737 7e7c5e4c balrog
    return s;
738 7e7c5e4c balrog
}
739 c580d92b balrog
740 c580d92b balrog
void *onenand_raw_otp(void *opaque)
741 c580d92b balrog
{
742 bc24a225 Paul Brook
    OneNANDState *s = (OneNANDState *) opaque;
743 c580d92b balrog
744 c580d92b balrog
    return s->otp;
745 c580d92b balrog
}