Statistics
| Branch: | Revision:

root / hw / mac_dbdma.c @ 1de7afc9

History | View | Annotate | Download (21.4 kB)

1
/*
2
 * PowerMac descriptor-based DMA emulation
3
 *
4
 * Copyright (c) 2005-2007 Fabrice Bellard
5
 * Copyright (c) 2007 Jocelyn Mayer
6
 * Copyright (c) 2009 Laurent Vivier
7
 *
8
 * some parts from linux-2.6.28, arch/powerpc/include/asm/dbdma.h
9
 *
10
 *   Definitions for using the Apple Descriptor-Based DMA controller
11
 *   in Power Macintosh computers.
12
 *
13
 *   Copyright (C) 1996 Paul Mackerras.
14
 *
15
 * some parts from mol 0.9.71
16
 *
17
 *   Descriptor based DMA emulation
18
 *
19
 *   Copyright (C) 1998-2004 Samuel Rydh (samuel@ibrium.se)
20
 *
21
 * Permission is hereby granted, free of charge, to any person obtaining a copy
22
 * of this software and associated documentation files (the "Software"), to deal
23
 * in the Software without restriction, including without limitation the rights
24
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
25
 * copies of the Software, and to permit persons to whom the Software is
26
 * furnished to do so, subject to the following conditions:
27
 *
28
 * The above copyright notice and this permission notice shall be included in
29
 * all copies or substantial portions of the Software.
30
 *
31
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
32
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
33
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
34
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
35
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
36
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
37
 * THE SOFTWARE.
38
 */
39
#include "hw.h"
40
#include "isa.h"
41
#include "mac_dbdma.h"
42
#include "qemu/main-loop.h"
43

    
44
/* debug DBDMA */
45
//#define DEBUG_DBDMA
46

    
47
#ifdef DEBUG_DBDMA
48
#define DBDMA_DPRINTF(fmt, ...)                                 \
49
    do { printf("DBDMA: " fmt , ## __VA_ARGS__); } while (0)
50
#else
51
#define DBDMA_DPRINTF(fmt, ...)
52
#endif
53

    
54
/*
55
 */
56

    
57
/*
58
 * DBDMA control/status registers.  All little-endian.
59
 */
60

    
61
#define DBDMA_CONTROL         0x00
62
#define DBDMA_STATUS          0x01
63
#define DBDMA_CMDPTR_HI       0x02
64
#define DBDMA_CMDPTR_LO       0x03
65
#define DBDMA_INTR_SEL        0x04
66
#define DBDMA_BRANCH_SEL      0x05
67
#define DBDMA_WAIT_SEL        0x06
68
#define DBDMA_XFER_MODE       0x07
69
#define DBDMA_DATA2PTR_HI     0x08
70
#define DBDMA_DATA2PTR_LO     0x09
71
#define DBDMA_RES1            0x0A
72
#define DBDMA_ADDRESS_HI      0x0B
73
#define DBDMA_BRANCH_ADDR_HI  0x0C
74
#define DBDMA_RES2            0x0D
75
#define DBDMA_RES3            0x0E
76
#define DBDMA_RES4            0x0F
77

    
78
#define DBDMA_REGS            16
79
#define DBDMA_SIZE            (DBDMA_REGS * sizeof(uint32_t))
80

    
81
#define DBDMA_CHANNEL_SHIFT   7
82
#define DBDMA_CHANNEL_SIZE    (1 << DBDMA_CHANNEL_SHIFT)
83

    
84
#define DBDMA_CHANNELS        (0x1000 >> DBDMA_CHANNEL_SHIFT)
85

    
86
/* Bits in control and status registers */
87

    
88
#define RUN        0x8000
89
#define PAUSE        0x4000
90
#define FLUSH        0x2000
91
#define WAKE        0x1000
92
#define DEAD        0x0800
93
#define ACTIVE        0x0400
94
#define BT        0x0100
95
#define DEVSTAT        0x00ff
96

    
97
/*
98
 * DBDMA command structure.  These fields are all little-endian!
99
 */
100

    
101
typedef struct dbdma_cmd {
102
    uint16_t req_count;          /* requested byte transfer count */
103
    uint16_t command;          /* command word (has bit-fields) */
104
    uint32_t phy_addr;          /* physical data address */
105
    uint32_t cmd_dep;          /* command-dependent field */
106
    uint16_t res_count;          /* residual count after completion */
107
    uint16_t xfer_status; /* transfer status */
108
} dbdma_cmd;
109

    
110
/* DBDMA command values in command field */
111

    
112
#define COMMAND_MASK    0xf000
113
#define OUTPUT_MORE        0x0000        /* transfer memory data to stream */
114
#define OUTPUT_LAST        0x1000        /* ditto followed by end marker */
115
#define INPUT_MORE        0x2000        /* transfer stream data to memory */
116
#define INPUT_LAST        0x3000        /* ditto, expect end marker */
117
#define STORE_WORD        0x4000        /* write word (4 bytes) to device reg */
118
#define LOAD_WORD        0x5000        /* read word (4 bytes) from device reg */
119
#define DBDMA_NOP        0x6000        /* do nothing */
120
#define DBDMA_STOP        0x7000        /* suspend processing */
121

    
122
/* Key values in command field */
123

    
124
#define KEY_MASK        0x0700
125
#define KEY_STREAM0        0x0000        /* usual data stream */
126
#define KEY_STREAM1        0x0100        /* control/status stream */
127
#define KEY_STREAM2        0x0200        /* device-dependent stream */
128
#define KEY_STREAM3        0x0300        /* device-dependent stream */
129
#define KEY_STREAM4        0x0400        /* reserved */
130
#define KEY_REGS        0x0500        /* device register space */
131
#define KEY_SYSTEM        0x0600        /* system memory-mapped space */
132
#define KEY_DEVICE        0x0700        /* device memory-mapped space */
133

    
134
/* Interrupt control values in command field */
135

    
136
#define INTR_MASK       0x0030
137
#define INTR_NEVER        0x0000        /* don't interrupt */
138
#define INTR_IFSET        0x0010        /* intr if condition bit is 1 */
139
#define INTR_IFCLR        0x0020        /* intr if condition bit is 0 */
140
#define INTR_ALWAYS        0x0030        /* always interrupt */
141

    
142
/* Branch control values in command field */
143

    
144
#define BR_MASK         0x000c
145
#define BR_NEVER        0x0000        /* don't branch */
146
#define BR_IFSET        0x0004        /* branch if condition bit is 1 */
147
#define BR_IFCLR        0x0008        /* branch if condition bit is 0 */
148
#define BR_ALWAYS        0x000c        /* always branch */
149

    
150
/* Wait control values in command field */
151

    
152
#define WAIT_MASK       0x0003
153
#define WAIT_NEVER        0x0000        /* don't wait */
154
#define WAIT_IFSET        0x0001        /* wait if condition bit is 1 */
155
#define WAIT_IFCLR        0x0002        /* wait if condition bit is 0 */
156
#define WAIT_ALWAYS        0x0003        /* always wait */
157

    
158
typedef struct DBDMA_channel {
159
    int channel;
160
    uint32_t regs[DBDMA_REGS];
161
    qemu_irq irq;
162
    DBDMA_io io;
163
    DBDMA_rw rw;
164
    DBDMA_flush flush;
165
    dbdma_cmd current;
166
    int processing;
167
} DBDMA_channel;
168

    
169
typedef struct {
170
    MemoryRegion mem;
171
    DBDMA_channel channels[DBDMA_CHANNELS];
172
} DBDMAState;
173

    
174
#ifdef DEBUG_DBDMA
175
static void dump_dbdma_cmd(dbdma_cmd *cmd)
176
{
177
    printf("dbdma_cmd %p\n", cmd);
178
    printf("    req_count 0x%04x\n", le16_to_cpu(cmd->req_count));
179
    printf("    command 0x%04x\n", le16_to_cpu(cmd->command));
180
    printf("    phy_addr 0x%08x\n", le32_to_cpu(cmd->phy_addr));
181
    printf("    cmd_dep 0x%08x\n", le32_to_cpu(cmd->cmd_dep));
182
    printf("    res_count 0x%04x\n", le16_to_cpu(cmd->res_count));
183
    printf("    xfer_status 0x%04x\n", le16_to_cpu(cmd->xfer_status));
184
}
185
#else
186
static void dump_dbdma_cmd(dbdma_cmd *cmd)
187
{
188
}
189
#endif
190
static void dbdma_cmdptr_load(DBDMA_channel *ch)
191
{
192
    DBDMA_DPRINTF("dbdma_cmdptr_load 0x%08x\n",
193
                  ch->regs[DBDMA_CMDPTR_LO]);
194
    cpu_physical_memory_read(ch->regs[DBDMA_CMDPTR_LO],
195
                             (uint8_t*)&ch->current, sizeof(dbdma_cmd));
196
}
197

    
198
static void dbdma_cmdptr_save(DBDMA_channel *ch)
199
{
200
    DBDMA_DPRINTF("dbdma_cmdptr_save 0x%08x\n",
201
                  ch->regs[DBDMA_CMDPTR_LO]);
202
    DBDMA_DPRINTF("xfer_status 0x%08x res_count 0x%04x\n",
203
                  le16_to_cpu(ch->current.xfer_status),
204
                  le16_to_cpu(ch->current.res_count));
205
    cpu_physical_memory_write(ch->regs[DBDMA_CMDPTR_LO],
206
                              (uint8_t*)&ch->current, sizeof(dbdma_cmd));
207
}
208

    
209
static void kill_channel(DBDMA_channel *ch)
210
{
211
    DBDMA_DPRINTF("kill_channel\n");
212

    
213
    ch->regs[DBDMA_STATUS] |= DEAD;
214
    ch->regs[DBDMA_STATUS] &= ~ACTIVE;
215

    
216
    qemu_irq_raise(ch->irq);
217
}
218

    
219
static void conditional_interrupt(DBDMA_channel *ch)
220
{
221
    dbdma_cmd *current = &ch->current;
222
    uint16_t intr;
223
    uint16_t sel_mask, sel_value;
224
    uint32_t status;
225
    int cond;
226

    
227
    DBDMA_DPRINTF("conditional_interrupt\n");
228

    
229
    intr = le16_to_cpu(current->command) & INTR_MASK;
230

    
231
    switch(intr) {
232
    case INTR_NEVER:  /* don't interrupt */
233
        return;
234
    case INTR_ALWAYS: /* always interrupt */
235
        qemu_irq_raise(ch->irq);
236
        return;
237
    }
238

    
239
    status = ch->regs[DBDMA_STATUS] & DEVSTAT;
240

    
241
    sel_mask = (ch->regs[DBDMA_INTR_SEL] >> 16) & 0x0f;
242
    sel_value = ch->regs[DBDMA_INTR_SEL] & 0x0f;
243

    
244
    cond = (status & sel_mask) == (sel_value & sel_mask);
245

    
246
    switch(intr) {
247
    case INTR_IFSET:  /* intr if condition bit is 1 */
248
        if (cond)
249
            qemu_irq_raise(ch->irq);
250
        return;
251
    case INTR_IFCLR:  /* intr if condition bit is 0 */
252
        if (!cond)
253
            qemu_irq_raise(ch->irq);
254
        return;
255
    }
256
}
257

    
258
static int conditional_wait(DBDMA_channel *ch)
259
{
260
    dbdma_cmd *current = &ch->current;
261
    uint16_t wait;
262
    uint16_t sel_mask, sel_value;
263
    uint32_t status;
264
    int cond;
265

    
266
    DBDMA_DPRINTF("conditional_wait\n");
267

    
268
    wait = le16_to_cpu(current->command) & WAIT_MASK;
269

    
270
    switch(wait) {
271
    case WAIT_NEVER:  /* don't wait */
272
        return 0;
273
    case WAIT_ALWAYS: /* always wait */
274
        return 1;
275
    }
276

    
277
    status = ch->regs[DBDMA_STATUS] & DEVSTAT;
278

    
279
    sel_mask = (ch->regs[DBDMA_WAIT_SEL] >> 16) & 0x0f;
280
    sel_value = ch->regs[DBDMA_WAIT_SEL] & 0x0f;
281

    
282
    cond = (status & sel_mask) == (sel_value & sel_mask);
283

    
284
    switch(wait) {
285
    case WAIT_IFSET:  /* wait if condition bit is 1 */
286
        if (cond)
287
            return 1;
288
        return 0;
289
    case WAIT_IFCLR:  /* wait if condition bit is 0 */
290
        if (!cond)
291
            return 1;
292
        return 0;
293
    }
294
    return 0;
295
}
296

    
297
static void next(DBDMA_channel *ch)
298
{
299
    uint32_t cp;
300

    
301
    ch->regs[DBDMA_STATUS] &= ~BT;
302

    
303
    cp = ch->regs[DBDMA_CMDPTR_LO];
304
    ch->regs[DBDMA_CMDPTR_LO] = cp + sizeof(dbdma_cmd);
305
    dbdma_cmdptr_load(ch);
306
}
307

    
308
static void branch(DBDMA_channel *ch)
309
{
310
    dbdma_cmd *current = &ch->current;
311

    
312
    ch->regs[DBDMA_CMDPTR_LO] = current->cmd_dep;
313
    ch->regs[DBDMA_STATUS] |= BT;
314
    dbdma_cmdptr_load(ch);
315
}
316

    
317
static void conditional_branch(DBDMA_channel *ch)
318
{
319
    dbdma_cmd *current = &ch->current;
320
    uint16_t br;
321
    uint16_t sel_mask, sel_value;
322
    uint32_t status;
323
    int cond;
324

    
325
    DBDMA_DPRINTF("conditional_branch\n");
326

    
327
    /* check if we must branch */
328

    
329
    br = le16_to_cpu(current->command) & BR_MASK;
330

    
331
    switch(br) {
332
    case BR_NEVER:  /* don't branch */
333
        next(ch);
334
        return;
335
    case BR_ALWAYS: /* always branch */
336
        branch(ch);
337
        return;
338
    }
339

    
340
    status = ch->regs[DBDMA_STATUS] & DEVSTAT;
341

    
342
    sel_mask = (ch->regs[DBDMA_BRANCH_SEL] >> 16) & 0x0f;
343
    sel_value = ch->regs[DBDMA_BRANCH_SEL] & 0x0f;
344

    
345
    cond = (status & sel_mask) == (sel_value & sel_mask);
346

    
347
    switch(br) {
348
    case BR_IFSET:  /* branch if condition bit is 1 */
349
        if (cond)
350
            branch(ch);
351
        else
352
            next(ch);
353
        return;
354
    case BR_IFCLR:  /* branch if condition bit is 0 */
355
        if (!cond)
356
            branch(ch);
357
        else
358
            next(ch);
359
        return;
360
    }
361
}
362

    
363
static QEMUBH *dbdma_bh;
364
static void channel_run(DBDMA_channel *ch);
365

    
366
static void dbdma_end(DBDMA_io *io)
367
{
368
    DBDMA_channel *ch = io->channel;
369
    dbdma_cmd *current = &ch->current;
370

    
371
    if (conditional_wait(ch))
372
        goto wait;
373

    
374
    current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
375
    current->res_count = cpu_to_le16(io->len);
376
    dbdma_cmdptr_save(ch);
377
    if (io->is_last)
378
        ch->regs[DBDMA_STATUS] &= ~FLUSH;
379

    
380
    conditional_interrupt(ch);
381
    conditional_branch(ch);
382

    
383
wait:
384
    ch->processing = 0;
385
    if ((ch->regs[DBDMA_STATUS] & RUN) &&
386
        (ch->regs[DBDMA_STATUS] & ACTIVE))
387
        channel_run(ch);
388
}
389

    
390
static void start_output(DBDMA_channel *ch, int key, uint32_t addr,
391
                        uint16_t req_count, int is_last)
392
{
393
    DBDMA_DPRINTF("start_output\n");
394

    
395
    /* KEY_REGS, KEY_DEVICE and KEY_STREAM
396
     * are not implemented in the mac-io chip
397
     */
398

    
399
    DBDMA_DPRINTF("addr 0x%x key 0x%x\n", addr, key);
400
    if (!addr || key > KEY_STREAM3) {
401
        kill_channel(ch);
402
        return;
403
    }
404

    
405
    ch->io.addr = addr;
406
    ch->io.len = req_count;
407
    ch->io.is_last = is_last;
408
    ch->io.dma_end = dbdma_end;
409
    ch->io.is_dma_out = 1;
410
    ch->processing = 1;
411
    if (ch->rw) {
412
        ch->rw(&ch->io);
413
    }
414
}
415

    
416
static void start_input(DBDMA_channel *ch, int key, uint32_t addr,
417
                       uint16_t req_count, int is_last)
418
{
419
    DBDMA_DPRINTF("start_input\n");
420

    
421
    /* KEY_REGS, KEY_DEVICE and KEY_STREAM
422
     * are not implemented in the mac-io chip
423
     */
424

    
425
    if (!addr || key > KEY_STREAM3) {
426
        kill_channel(ch);
427
        return;
428
    }
429

    
430
    ch->io.addr = addr;
431
    ch->io.len = req_count;
432
    ch->io.is_last = is_last;
433
    ch->io.dma_end = dbdma_end;
434
    ch->io.is_dma_out = 0;
435
    ch->processing = 1;
436
    if (ch->rw) {
437
        ch->rw(&ch->io);
438
    }
439
}
440

    
441
static void load_word(DBDMA_channel *ch, int key, uint32_t addr,
442
                     uint16_t len)
443
{
444
    dbdma_cmd *current = &ch->current;
445
    uint32_t val;
446

    
447
    DBDMA_DPRINTF("load_word\n");
448

    
449
    /* only implements KEY_SYSTEM */
450

    
451
    if (key != KEY_SYSTEM) {
452
        printf("DBDMA: LOAD_WORD, unimplemented key %x\n", key);
453
        kill_channel(ch);
454
        return;
455
    }
456

    
457
    cpu_physical_memory_read(addr, (uint8_t*)&val, len);
458

    
459
    if (len == 2)
460
        val = (val << 16) | (current->cmd_dep & 0x0000ffff);
461
    else if (len == 1)
462
        val = (val << 24) | (current->cmd_dep & 0x00ffffff);
463

    
464
    current->cmd_dep = val;
465

    
466
    if (conditional_wait(ch))
467
        goto wait;
468

    
469
    current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
470
    dbdma_cmdptr_save(ch);
471
    ch->regs[DBDMA_STATUS] &= ~FLUSH;
472

    
473
    conditional_interrupt(ch);
474
    next(ch);
475

    
476
wait:
477
    qemu_bh_schedule(dbdma_bh);
478
}
479

    
480
static void store_word(DBDMA_channel *ch, int key, uint32_t addr,
481
                      uint16_t len)
482
{
483
    dbdma_cmd *current = &ch->current;
484
    uint32_t val;
485

    
486
    DBDMA_DPRINTF("store_word\n");
487

    
488
    /* only implements KEY_SYSTEM */
489

    
490
    if (key != KEY_SYSTEM) {
491
        printf("DBDMA: STORE_WORD, unimplemented key %x\n", key);
492
        kill_channel(ch);
493
        return;
494
    }
495

    
496
    val = current->cmd_dep;
497
    if (len == 2)
498
        val >>= 16;
499
    else if (len == 1)
500
        val >>= 24;
501

    
502
    cpu_physical_memory_write(addr, (uint8_t*)&val, len);
503

    
504
    if (conditional_wait(ch))
505
        goto wait;
506

    
507
    current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
508
    dbdma_cmdptr_save(ch);
509
    ch->regs[DBDMA_STATUS] &= ~FLUSH;
510

    
511
    conditional_interrupt(ch);
512
    next(ch);
513

    
514
wait:
515
    qemu_bh_schedule(dbdma_bh);
516
}
517

    
518
static void nop(DBDMA_channel *ch)
519
{
520
    dbdma_cmd *current = &ch->current;
521

    
522
    if (conditional_wait(ch))
523
        goto wait;
524

    
525
    current->xfer_status = cpu_to_le16(ch->regs[DBDMA_STATUS]);
526
    dbdma_cmdptr_save(ch);
527

    
528
    conditional_interrupt(ch);
529
    conditional_branch(ch);
530

    
531
wait:
532
    qemu_bh_schedule(dbdma_bh);
533
}
534

    
535
static void stop(DBDMA_channel *ch)
536
{
537
    ch->regs[DBDMA_STATUS] &= ~(ACTIVE|DEAD|FLUSH);
538

    
539
    /* the stop command does not increment command pointer */
540
}
541

    
542
static void channel_run(DBDMA_channel *ch)
543
{
544
    dbdma_cmd *current = &ch->current;
545
    uint16_t cmd, key;
546
    uint16_t req_count;
547
    uint32_t phy_addr;
548

    
549
    DBDMA_DPRINTF("channel_run\n");
550
    dump_dbdma_cmd(current);
551

    
552
    /* clear WAKE flag at command fetch */
553

    
554
    ch->regs[DBDMA_STATUS] &= ~WAKE;
555

    
556
    cmd = le16_to_cpu(current->command) & COMMAND_MASK;
557

    
558
    switch (cmd) {
559
    case DBDMA_NOP:
560
        nop(ch);
561
        return;
562

    
563
    case DBDMA_STOP:
564
        stop(ch);
565
        return;
566
    }
567

    
568
    key = le16_to_cpu(current->command) & 0x0700;
569
    req_count = le16_to_cpu(current->req_count);
570
    phy_addr = le32_to_cpu(current->phy_addr);
571

    
572
    if (key == KEY_STREAM4) {
573
        printf("command %x, invalid key 4\n", cmd);
574
        kill_channel(ch);
575
        return;
576
    }
577

    
578
    switch (cmd) {
579
    case OUTPUT_MORE:
580
        start_output(ch, key, phy_addr, req_count, 0);
581
        return;
582

    
583
    case OUTPUT_LAST:
584
        start_output(ch, key, phy_addr, req_count, 1);
585
        return;
586

    
587
    case INPUT_MORE:
588
        start_input(ch, key, phy_addr, req_count, 0);
589
        return;
590

    
591
    case INPUT_LAST:
592
        start_input(ch, key, phy_addr, req_count, 1);
593
        return;
594
    }
595

    
596
    if (key < KEY_REGS) {
597
        printf("command %x, invalid key %x\n", cmd, key);
598
        key = KEY_SYSTEM;
599
    }
600

    
601
    /* for LOAD_WORD and STORE_WORD, req_count is on 3 bits
602
     * and BRANCH is invalid
603
     */
604

    
605
    req_count = req_count & 0x0007;
606
    if (req_count & 0x4) {
607
        req_count = 4;
608
        phy_addr &= ~3;
609
    } else if (req_count & 0x2) {
610
        req_count = 2;
611
        phy_addr &= ~1;
612
    } else
613
        req_count = 1;
614

    
615
    switch (cmd) {
616
    case LOAD_WORD:
617
        load_word(ch, key, phy_addr, req_count);
618
        return;
619

    
620
    case STORE_WORD:
621
        store_word(ch, key, phy_addr, req_count);
622
        return;
623
    }
624
}
625

    
626
static void DBDMA_run(DBDMAState *s)
627
{
628
    int channel;
629

    
630
    for (channel = 0; channel < DBDMA_CHANNELS; channel++) {
631
        DBDMA_channel *ch = &s->channels[channel];
632
        uint32_t status = ch->regs[DBDMA_STATUS];
633
        if (!ch->processing && (status & RUN) && (status & ACTIVE)) {
634
            channel_run(ch);
635
        }
636
    }
637
}
638

    
639
static void DBDMA_run_bh(void *opaque)
640
{
641
    DBDMAState *s = opaque;
642

    
643
    DBDMA_DPRINTF("DBDMA_run_bh\n");
644

    
645
    DBDMA_run(s);
646
}
647

    
648
void DBDMA_register_channel(void *dbdma, int nchan, qemu_irq irq,
649
                            DBDMA_rw rw, DBDMA_flush flush,
650
                            void *opaque)
651
{
652
    DBDMAState *s = dbdma;
653
    DBDMA_channel *ch = &s->channels[nchan];
654

    
655
    DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan);
656

    
657
    ch->irq = irq;
658
    ch->channel = nchan;
659
    ch->rw = rw;
660
    ch->flush = flush;
661
    ch->io.opaque = opaque;
662
    ch->io.channel = ch;
663
}
664

    
665
static void
666
dbdma_control_write(DBDMA_channel *ch)
667
{
668
    uint16_t mask, value;
669
    uint32_t status;
670

    
671
    mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
672
    value = ch->regs[DBDMA_CONTROL] & 0xffff;
673

    
674
    value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT);
675

    
676
    status = ch->regs[DBDMA_STATUS];
677

    
678
    status = (value & mask) | (status & ~mask);
679

    
680
    if (status & WAKE)
681
        status |= ACTIVE;
682
    if (status & RUN) {
683
        status |= ACTIVE;
684
        status &= ~DEAD;
685
    }
686
    if (status & PAUSE)
687
        status &= ~ACTIVE;
688
    if ((ch->regs[DBDMA_STATUS] & RUN) && !(status & RUN)) {
689
        /* RUN is cleared */
690
        status &= ~(ACTIVE|DEAD);
691
    }
692

    
693
    DBDMA_DPRINTF("    status 0x%08x\n", status);
694

    
695
    ch->regs[DBDMA_STATUS] = status;
696

    
697
    if (status & ACTIVE)
698
        qemu_bh_schedule(dbdma_bh);
699
    if ((status & FLUSH) && ch->flush)
700
        ch->flush(&ch->io);
701
}
702

    
703
static void dbdma_write(void *opaque, hwaddr addr,
704
                        uint64_t value, unsigned size)
705
{
706
    int channel = addr >> DBDMA_CHANNEL_SHIFT;
707
    DBDMAState *s = opaque;
708
    DBDMA_channel *ch = &s->channels[channel];
709
    int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
710

    
711
    DBDMA_DPRINTF("writel 0x" TARGET_FMT_plx " <= 0x%08x\n", addr, value);
712
    DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
713
                  (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
714

    
715
    /* cmdptr cannot be modified if channel is RUN or ACTIVE */
716

    
717
    if (reg == DBDMA_CMDPTR_LO &&
718
        (ch->regs[DBDMA_STATUS] & (RUN | ACTIVE)))
719
        return;
720

    
721
    ch->regs[reg] = value;
722

    
723
    switch(reg) {
724
    case DBDMA_CONTROL:
725
        dbdma_control_write(ch);
726
        break;
727
    case DBDMA_CMDPTR_LO:
728
        /* 16-byte aligned */
729
        ch->regs[DBDMA_CMDPTR_LO] &= ~0xf;
730
        dbdma_cmdptr_load(ch);
731
        break;
732
    case DBDMA_STATUS:
733
    case DBDMA_INTR_SEL:
734
    case DBDMA_BRANCH_SEL:
735
    case DBDMA_WAIT_SEL:
736
        /* nothing to do */
737
        break;
738
    case DBDMA_XFER_MODE:
739
    case DBDMA_CMDPTR_HI:
740
    case DBDMA_DATA2PTR_HI:
741
    case DBDMA_DATA2PTR_LO:
742
    case DBDMA_ADDRESS_HI:
743
    case DBDMA_BRANCH_ADDR_HI:
744
    case DBDMA_RES1:
745
    case DBDMA_RES2:
746
    case DBDMA_RES3:
747
    case DBDMA_RES4:
748
        /* unused */
749
        break;
750
    }
751
}
752

    
753
static uint64_t dbdma_read(void *opaque, hwaddr addr,
754
                           unsigned size)
755
{
756
    uint32_t value;
757
    int channel = addr >> DBDMA_CHANNEL_SHIFT;
758
    DBDMAState *s = opaque;
759
    DBDMA_channel *ch = &s->channels[channel];
760
    int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
761

    
762
    value = ch->regs[reg];
763

    
764
    DBDMA_DPRINTF("readl 0x" TARGET_FMT_plx " => 0x%08x\n", addr, value);
765
    DBDMA_DPRINTF("channel 0x%x reg 0x%x\n",
766
                  (uint32_t)addr >> DBDMA_CHANNEL_SHIFT, reg);
767

    
768
    switch(reg) {
769
    case DBDMA_CONTROL:
770
        value = 0;
771
        break;
772
    case DBDMA_STATUS:
773
    case DBDMA_CMDPTR_LO:
774
    case DBDMA_INTR_SEL:
775
    case DBDMA_BRANCH_SEL:
776
    case DBDMA_WAIT_SEL:
777
        /* nothing to do */
778
        break;
779
    case DBDMA_XFER_MODE:
780
    case DBDMA_CMDPTR_HI:
781
    case DBDMA_DATA2PTR_HI:
782
    case DBDMA_DATA2PTR_LO:
783
    case DBDMA_ADDRESS_HI:
784
    case DBDMA_BRANCH_ADDR_HI:
785
        /* unused */
786
        value = 0;
787
        break;
788
    case DBDMA_RES1:
789
    case DBDMA_RES2:
790
    case DBDMA_RES3:
791
    case DBDMA_RES4:
792
        /* reserved */
793
        break;
794
    }
795

    
796
    return value;
797
}
798

    
799
static const MemoryRegionOps dbdma_ops = {
800
    .read = dbdma_read,
801
    .write = dbdma_write,
802
    .endianness = DEVICE_LITTLE_ENDIAN,
803
    .valid = {
804
        .min_access_size = 4,
805
        .max_access_size = 4,
806
    },
807
};
808

    
809
static const VMStateDescription vmstate_dbdma_channel = {
810
    .name = "dbdma_channel",
811
    .version_id = 0,
812
    .minimum_version_id = 0,
813
    .minimum_version_id_old = 0,
814
    .fields      = (VMStateField[]) {
815
        VMSTATE_UINT32_ARRAY(regs, struct DBDMA_channel, DBDMA_REGS),
816
        VMSTATE_END_OF_LIST()
817
    }
818
};
819

    
820
static const VMStateDescription vmstate_dbdma = {
821
    .name = "dbdma",
822
    .version_id = 2,
823
    .minimum_version_id = 2,
824
    .minimum_version_id_old = 2,
825
    .fields      = (VMStateField[]) {
826
        VMSTATE_STRUCT_ARRAY(channels, DBDMAState, DBDMA_CHANNELS, 1,
827
                             vmstate_dbdma_channel, DBDMA_channel),
828
        VMSTATE_END_OF_LIST()
829
    }
830
};
831

    
832
static void dbdma_reset(void *opaque)
833
{
834
    DBDMAState *s = opaque;
835
    int i;
836

    
837
    for (i = 0; i < DBDMA_CHANNELS; i++)
838
        memset(s->channels[i].regs, 0, DBDMA_SIZE);
839
}
840

    
841
void* DBDMA_init (MemoryRegion **dbdma_mem)
842
{
843
    DBDMAState *s;
844

    
845
    s = g_malloc0(sizeof(DBDMAState));
846

    
847
    memory_region_init_io(&s->mem, &dbdma_ops, s, "dbdma", 0x1000);
848
    *dbdma_mem = &s->mem;
849
    vmstate_register(NULL, -1, &vmstate_dbdma, s);
850
    qemu_register_reset(dbdma_reset, s);
851

    
852
    dbdma_bh = qemu_bh_new(DBDMA_run_bh, s);
853

    
854
    return s;
855
}