Statistics
| Branch: | Revision:

root / hw / mac_dbdma.c @ c6df7102

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

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

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

    
53
/*
54
 */
55

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

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

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

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

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

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

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

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

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

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

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

    
121
/* Key values in command field */
122

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

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

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

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

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

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

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

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

    
168
typedef struct {
169
    DBDMA_channel channels[DBDMA_CHANNELS];
170
} DBDMAState;
171

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

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

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

    
211
    ch->regs[DBDMA_STATUS] |= DEAD;
212
    ch->regs[DBDMA_STATUS] &= ~ACTIVE;
213

    
214
    qemu_irq_raise(ch->irq);
215
}
216

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

    
225
    DBDMA_DPRINTF("conditional_interrupt\n");
226

    
227
    intr = le16_to_cpu(current->command) & INTR_MASK;
228

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

    
237
    status = ch->regs[DBDMA_STATUS] & DEVSTAT;
238

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

    
242
    cond = (status & sel_mask) == (sel_value & sel_mask);
243

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

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

    
264
    DBDMA_DPRINTF("conditional_wait\n");
265

    
266
    wait = le16_to_cpu(current->command) & WAIT_MASK;
267

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

    
275
    status = ch->regs[DBDMA_STATUS] & DEVSTAT;
276

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

    
280
    cond = (status & sel_mask) == (sel_value & sel_mask);
281

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

    
295
static void next(DBDMA_channel *ch)
296
{
297
    uint32_t cp;
298

    
299
    ch->regs[DBDMA_STATUS] &= ~BT;
300

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

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

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

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

    
323
    DBDMA_DPRINTF("conditional_branch\n");
324

    
325
    /* check if we must branch */
326

    
327
    br = le16_to_cpu(current->command) & BR_MASK;
328

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

    
338
    status = ch->regs[DBDMA_STATUS] & DEVSTAT;
339

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

    
343
    cond = (status & sel_mask) == (sel_value & sel_mask);
344

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

    
361
static QEMUBH *dbdma_bh;
362
static void channel_run(DBDMA_channel *ch);
363

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

    
369
    if (conditional_wait(ch))
370
        goto wait;
371

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

    
378
    conditional_interrupt(ch);
379
    conditional_branch(ch);
380

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

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

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

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

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

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

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

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

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

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

    
445
    DBDMA_DPRINTF("load_word\n");
446

    
447
    /* only implements KEY_SYSTEM */
448

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

    
455
    cpu_physical_memory_read(addr, (uint8_t*)&val, len);
456

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

    
462
    current->cmd_dep = val;
463

    
464
    if (conditional_wait(ch))
465
        goto wait;
466

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

    
471
    conditional_interrupt(ch);
472
    next(ch);
473

    
474
wait:
475
    qemu_bh_schedule(dbdma_bh);
476
}
477

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

    
484
    DBDMA_DPRINTF("store_word\n");
485

    
486
    /* only implements KEY_SYSTEM */
487

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

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

    
500
    cpu_physical_memory_write(addr, (uint8_t*)&val, len);
501

    
502
    if (conditional_wait(ch))
503
        goto wait;
504

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

    
509
    conditional_interrupt(ch);
510
    next(ch);
511

    
512
wait:
513
    qemu_bh_schedule(dbdma_bh);
514
}
515

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

    
520
    if (conditional_wait(ch))
521
        goto wait;
522

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

    
526
    conditional_interrupt(ch);
527
    conditional_branch(ch);
528

    
529
wait:
530
    qemu_bh_schedule(dbdma_bh);
531
}
532

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

    
537
    /* the stop command does not increment command pointer */
538
}
539

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

    
547
    DBDMA_DPRINTF("channel_run\n");
548
    dump_dbdma_cmd(current);
549

    
550
    /* clear WAKE flag at command fetch */
551

    
552
    ch->regs[DBDMA_STATUS] &= ~WAKE;
553

    
554
    cmd = le16_to_cpu(current->command) & COMMAND_MASK;
555

    
556
    switch (cmd) {
557
    case DBDMA_NOP:
558
        nop(ch);
559
        return;
560

    
561
    case DBDMA_STOP:
562
        stop(ch);
563
        return;
564
    }
565

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

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

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

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

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

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

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

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

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

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

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

    
624
static void DBDMA_run(DBDMAState *s)
625
{
626
    int channel;
627

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

    
637
static void DBDMA_run_bh(void *opaque)
638
{
639
    DBDMAState *s = opaque;
640

    
641
    DBDMA_DPRINTF("DBDMA_run_bh\n");
642

    
643
    DBDMA_run(s);
644
}
645

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

    
653
    DBDMA_DPRINTF("DBDMA_register_channel 0x%x\n", nchan);
654

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

    
663
void DBDMA_schedule(void)
664
{
665
    qemu_notify_event();
666
}
667

    
668
static void
669
dbdma_control_write(DBDMA_channel *ch)
670
{
671
    uint16_t mask, value;
672
    uint32_t status;
673

    
674
    mask = (ch->regs[DBDMA_CONTROL] >> 16) & 0xffff;
675
    value = ch->regs[DBDMA_CONTROL] & 0xffff;
676

    
677
    value &= (RUN | PAUSE | FLUSH | WAKE | DEVSTAT);
678

    
679
    status = ch->regs[DBDMA_STATUS];
680

    
681
    status = (value & mask) | (status & ~mask);
682

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

    
696
    DBDMA_DPRINTF("    status 0x%08x\n", status);
697

    
698
    ch->regs[DBDMA_STATUS] = status;
699

    
700
    if (status & ACTIVE)
701
        qemu_bh_schedule(dbdma_bh);
702
    if ((status & FLUSH) && ch->flush)
703
        ch->flush(&ch->io);
704
}
705

    
706
static void dbdma_writel (void *opaque,
707
                          target_phys_addr_t addr, uint32_t value)
708
{
709
    int channel = addr >> DBDMA_CHANNEL_SHIFT;
710
    DBDMAState *s = opaque;
711
    DBDMA_channel *ch = &s->channels[channel];
712
    int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
713

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

    
718
    /* cmdptr cannot be modified if channel is RUN or ACTIVE */
719

    
720
    if (reg == DBDMA_CMDPTR_LO &&
721
        (ch->regs[DBDMA_STATUS] & (RUN | ACTIVE)))
722
        return;
723

    
724
    ch->regs[reg] = value;
725

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

    
756
static uint32_t dbdma_readl (void *opaque, target_phys_addr_t addr)
757
{
758
    uint32_t value;
759
    int channel = addr >> DBDMA_CHANNEL_SHIFT;
760
    DBDMAState *s = opaque;
761
    DBDMA_channel *ch = &s->channels[channel];
762
    int reg = (addr - (channel << DBDMA_CHANNEL_SHIFT)) >> 2;
763

    
764
    value = ch->regs[reg];
765

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

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

    
798
    return value;
799
}
800

    
801
static CPUWriteMemoryFunc * const dbdma_write[] = {
802
    NULL,
803
    NULL,
804
    dbdma_writel,
805
};
806

    
807
static CPUReadMemoryFunc * const dbdma_read[] = {
808
    NULL,
809
    NULL,
810
    dbdma_readl,
811
};
812

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

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

    
836
static void dbdma_reset(void *opaque)
837
{
838
    DBDMAState *s = opaque;
839
    int i;
840

    
841
    for (i = 0; i < DBDMA_CHANNELS; i++)
842
        memset(s->channels[i].regs, 0, DBDMA_SIZE);
843
}
844

    
845
void* DBDMA_init (int *dbdma_mem_index)
846
{
847
    DBDMAState *s;
848

    
849
    s = qemu_mallocz(sizeof(DBDMAState));
850

    
851
    *dbdma_mem_index = cpu_register_io_memory(dbdma_read, dbdma_write, s,
852
                                              DEVICE_LITTLE_ENDIAN);
853
    vmstate_register(NULL, -1, &vmstate_dbdma, s);
854
    qemu_register_reset(dbdma_reset, s);
855

    
856
    dbdma_bh = qemu_bh_new(DBDMA_run_bh, s);
857

    
858
    return s;
859
}