4 * Copyright (c) 2003-2004 Vassili Karpov (malc)
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
24 #include "qemu/osdep.h"
26 #include "hw/isa/isa.h"
27 #include "hw/isa/i8257.h"
28 #include "qemu/main-loop.h"
32 OBJECT_CHECK(I8257State, (obj), TYPE_I8257)
34 /* #define DEBUG_DMA */
36 #define dolog(...) fprintf (stderr, "dma: " __VA_ARGS__)
38 #define linfo(...) fprintf (stderr, "dma: " __VA_ARGS__)
39 #define ldebug(...) fprintf (stderr, "dma: " __VA_ARGS__)
48 static I8257State
*dma_controllers
[2];
51 CMD_MEMORY_TO_MEMORY
= 0x01,
52 CMD_FIXED_ADDRESS
= 0x02,
53 CMD_BLOCK_CONTROLLER
= 0x04,
54 CMD_COMPRESSED_TIME
= 0x08,
55 CMD_CYCLIC_PRIORITY
= 0x10,
56 CMD_EXTENDED_WRITE
= 0x20,
59 CMD_NOT_SUPPORTED
= CMD_MEMORY_TO_MEMORY
| CMD_FIXED_ADDRESS
60 | CMD_COMPRESSED_TIME
| CMD_CYCLIC_PRIORITY
| CMD_EXTENDED_WRITE
61 | CMD_LOW_DREQ
| CMD_LOW_DACK
65 static void i8257_dma_run(void *opaque
);
67 static const int channels
[8] = {-1, 2, 3, 1, -1, -1, -1, 0};
69 static void i8257_write_page(void *opaque
, uint32_t nport
, uint32_t data
)
71 I8257State
*d
= opaque
;
74 ichan
= channels
[nport
& 7];
76 dolog ("invalid channel %#x %#x\n", nport
, data
);
79 d
->regs
[ichan
].page
= data
;
82 static void i8257_write_pageh(void *opaque
, uint32_t nport
, uint32_t data
)
84 I8257State
*d
= opaque
;
87 ichan
= channels
[nport
& 7];
89 dolog ("invalid channel %#x %#x\n", nport
, data
);
92 d
->regs
[ichan
].pageh
= data
;
95 static uint32_t i8257_read_page(void *opaque
, uint32_t nport
)
97 I8257State
*d
= opaque
;
100 ichan
= channels
[nport
& 7];
102 dolog ("invalid channel read %#x\n", nport
);
105 return d
->regs
[ichan
].page
;
108 static uint32_t i8257_read_pageh(void *opaque
, uint32_t nport
)
110 I8257State
*d
= opaque
;
113 ichan
= channels
[nport
& 7];
115 dolog ("invalid channel read %#x\n", nport
);
118 return d
->regs
[ichan
].pageh
;
121 static inline void i8257_init_chan(I8257State
*d
, int ichan
)
126 r
->now
[ADDR
] = r
->base
[ADDR
] << d
->dshift
;
130 static inline int i8257_getff(I8257State
*d
)
139 static uint64_t i8257_read_chan(void *opaque
, hwaddr nport
, unsigned size
)
141 I8257State
*d
= opaque
;
142 int ichan
, nreg
, iport
, ff
, val
, dir
;
145 iport
= (nport
>> d
->dshift
) & 0x0f;
150 dir
= ((r
->mode
>> 5) & 1) ? -1 : 1;
153 val
= (r
->base
[COUNT
] << d
->dshift
) - r
->now
[COUNT
];
155 val
= r
->now
[ADDR
] + r
->now
[COUNT
] * dir
;
157 ldebug ("read_chan %#x -> %d\n", iport
, val
);
158 return (val
>> (d
->dshift
+ (ff
<< 3))) & 0xff;
161 static void i8257_write_chan(void *opaque
, hwaddr nport
, uint64_t data
,
164 I8257State
*d
= opaque
;
165 int iport
, ichan
, nreg
;
168 iport
= (nport
>> d
->dshift
) & 0x0f;
172 if (i8257_getff(d
)) {
173 r
->base
[nreg
] = (r
->base
[nreg
] & 0xff) | ((data
<< 8) & 0xff00);
174 i8257_init_chan(d
, ichan
);
176 r
->base
[nreg
] = (r
->base
[nreg
] & 0xff00) | (data
& 0xff);
180 static void i8257_write_cont(void *opaque
, hwaddr nport
, uint64_t data
,
183 I8257State
*d
= opaque
;
184 int iport
, ichan
= 0;
186 iport
= (nport
>> d
->dshift
) & 0x0f;
188 case 0x00: /* command */
189 if ((data
!= 0) && (data
& CMD_NOT_SUPPORTED
)) {
190 dolog("command %"PRIx64
" not supported\n", data
);
199 d
->status
|= 1 << (ichan
+ 4);
202 d
->status
&= ~(1 << (ichan
+ 4));
204 d
->status
&= ~(1 << ichan
);
208 case 0x02: /* single mask */
210 d
->mask
|= 1 << (data
& 3);
212 d
->mask
&= ~(1 << (data
& 3));
216 case 0x03: /* mode */
221 int op
, ai
, dir
, opmode
;
222 op
= (data
>> 2) & 3;
223 ai
= (data
>> 4) & 1;
224 dir
= (data
>> 5) & 1;
225 opmode
= (data
>> 6) & 3;
227 linfo ("ichan %d, op %d, ai %d, dir %d, opmode %d\n",
228 ichan
, op
, ai
, dir
, opmode
);
231 d
->regs
[ichan
].mode
= data
;
235 case 0x04: /* clear flip flop */
239 case 0x05: /* reset */
246 case 0x06: /* clear mask for all channels */
251 case 0x07: /* write mask for all channels */
257 dolog ("unknown iport %#x\n", iport
);
263 linfo ("write_cont: nport %#06x, ichan % 2d, val %#06x\n",
269 static uint64_t i8257_read_cont(void *opaque
, hwaddr nport
, unsigned size
)
271 I8257State
*d
= opaque
;
274 iport
= (nport
>> d
->dshift
) & 0x0f;
276 case 0x00: /* status */
280 case 0x01: /* mask */
288 ldebug ("read_cont: nport %#06x, iport %#04x val %#x\n", nport
, iport
, val
);
292 int DMA_get_channel_mode (int nchan
)
294 return dma_controllers
[nchan
> 3]->regs
[nchan
& 3].mode
;
297 void DMA_hold_DREQ (int nchan
)
303 linfo ("held cont=%d chan=%d\n", ncont
, ichan
);
304 dma_controllers
[ncont
]->status
|= 1 << (ichan
+ 4);
305 i8257_dma_run(dma_controllers
[ncont
]);
308 void DMA_release_DREQ (int nchan
)
314 linfo ("released cont=%d chan=%d\n", ncont
, ichan
);
315 dma_controllers
[ncont
]->status
&= ~(1 << (ichan
+ 4));
316 i8257_dma_run(dma_controllers
[ncont
]);
319 static void i8257_channel_run(I8257State
*d
, int ichan
)
321 int ncont
= d
->dshift
;
323 I8257Regs
*r
= &d
->regs
[ichan
];
327 dir
= (r
->mode
>> 5) & 1;
328 opmode
= (r
->mode
>> 6) & 3;
331 dolog ("DMA in address decrement mode\n");
334 dolog ("DMA not in single mode select %#x\n", opmode
);
338 n
= r
->transfer_handler (r
->opaque
, ichan
+ (ncont
<< 2),
339 r
->now
[COUNT
], (r
->base
[COUNT
] + 1) << ncont
);
341 ldebug ("dma_pos %d size %d\n", n
, (r
->base
[COUNT
] + 1) << ncont
);
344 static void i8257_dma_run(void *opaque
)
346 I8257State
*d
= opaque
;
357 for (ichan
= 0; ichan
< 4; ichan
++) {
362 if ((0 == (d
->mask
& mask
)) && (0 != (d
->status
& (mask
<< 4)))) {
363 i8257_channel_run(d
, ichan
);
371 qemu_bh_schedule_idle(d
->dma_bh
);
372 d
->dma_bh_scheduled
= true;
376 void DMA_register_channel (int nchan
,
377 DMA_transfer_handler transfer_handler
,
386 r
= dma_controllers
[ncont
]->regs
+ ichan
;
387 r
->transfer_handler
= transfer_handler
;
391 int DMA_read_memory (int nchan
, void *buf
, int pos
, int len
)
393 I8257Regs
*r
= &dma_controllers
[nchan
> 3]->regs
[nchan
& 3];
394 hwaddr addr
= ((r
->pageh
& 0x7f) << 24) | (r
->page
<< 16) | r
->now
[ADDR
];
396 if (r
->mode
& 0x20) {
400 cpu_physical_memory_read (addr
- pos
- len
, buf
, len
);
401 /* What about 16bit transfers? */
402 for (i
= 0; i
< len
>> 1; i
++) {
403 uint8_t b
= p
[len
- i
- 1];
408 cpu_physical_memory_read (addr
+ pos
, buf
, len
);
413 int DMA_write_memory (int nchan
, void *buf
, int pos
, int len
)
415 I8257Regs
*r
= &dma_controllers
[nchan
> 3]->regs
[nchan
& 3];
416 hwaddr addr
= ((r
->pageh
& 0x7f) << 24) | (r
->page
<< 16) | r
->now
[ADDR
];
418 if (r
->mode
& 0x20) {
422 cpu_physical_memory_write (addr
- pos
- len
, buf
, len
);
423 /* What about 16bit transfers? */
424 for (i
= 0; i
< len
; i
++) {
425 uint8_t b
= p
[len
- i
- 1];
430 cpu_physical_memory_write (addr
+ pos
, buf
, len
);
435 /* request the emulator to transfer a new DMA memory block ASAP (even
436 * if the idle bottom half would not have exited the iothread yet).
438 void DMA_schedule(void)
440 if (dma_controllers
[0]->dma_bh_scheduled
||
441 dma_controllers
[1]->dma_bh_scheduled
) {
446 static void i8257_reset(DeviceState
*dev
)
448 I8257State
*d
= I8257(dev
);
449 i8257_write_cont(d
, (0x05 << d
->dshift
), 0, 1);
452 static int i8257_phony_handler(void *opaque
, int nchan
, int dma_pos
,
455 trace_i8257_unregistered_dma(nchan
, dma_pos
, dma_len
);
460 static const MemoryRegionOps channel_io_ops
= {
461 .read
= i8257_read_chan
,
462 .write
= i8257_write_chan
,
463 .endianness
= DEVICE_NATIVE_ENDIAN
,
465 .min_access_size
= 1,
466 .max_access_size
= 1,
470 /* IOport from page_base */
471 static const MemoryRegionPortio page_portio_list
[] = {
472 { 0x01, 3, 1, .write
= i8257_write_page
, .read
= i8257_read_page
, },
473 { 0x07, 1, 1, .write
= i8257_write_page
, .read
= i8257_read_page
, },
474 PORTIO_END_OF_LIST(),
477 /* IOport from pageh_base */
478 static const MemoryRegionPortio pageh_portio_list
[] = {
479 { 0x01, 3, 1, .write
= i8257_write_pageh
, .read
= i8257_read_pageh
, },
480 { 0x07, 3, 1, .write
= i8257_write_pageh
, .read
= i8257_read_pageh
, },
481 PORTIO_END_OF_LIST(),
484 static const MemoryRegionOps cont_io_ops
= {
485 .read
= i8257_read_cont
,
486 .write
= i8257_write_cont
,
487 .endianness
= DEVICE_NATIVE_ENDIAN
,
489 .min_access_size
= 1,
490 .max_access_size
= 1,
494 static const VMStateDescription vmstate_i8257_regs
= {
497 .minimum_version_id
= 1,
498 .fields
= (VMStateField
[]) {
499 VMSTATE_INT32_ARRAY(now
, I8257Regs
, 2),
500 VMSTATE_UINT16_ARRAY(base
, I8257Regs
, 2),
501 VMSTATE_UINT8(mode
, I8257Regs
),
502 VMSTATE_UINT8(page
, I8257Regs
),
503 VMSTATE_UINT8(pageh
, I8257Regs
),
504 VMSTATE_UINT8(dack
, I8257Regs
),
505 VMSTATE_UINT8(eop
, I8257Regs
),
506 VMSTATE_END_OF_LIST()
510 static int i8257_post_load(void *opaque
, int version_id
)
512 I8257State
*d
= opaque
;
518 static const VMStateDescription vmstate_i8257
= {
521 .minimum_version_id
= 1,
522 .post_load
= i8257_post_load
,
523 .fields
= (VMStateField
[]) {
524 VMSTATE_UINT8(command
, I8257State
),
525 VMSTATE_UINT8(mask
, I8257State
),
526 VMSTATE_UINT8(flip_flop
, I8257State
),
527 VMSTATE_INT32(dshift
, I8257State
),
528 VMSTATE_STRUCT_ARRAY(regs
, I8257State
, 4, 1, vmstate_i8257_regs
,
530 VMSTATE_END_OF_LIST()
534 static void i8257_realize(DeviceState
*dev
, Error
**errp
)
536 ISADevice
*isa
= ISA_DEVICE(dev
);
537 I8257State
*d
= I8257(dev
);
540 memory_region_init_io(&d
->channel_io
, NULL
, &channel_io_ops
, d
,
541 "dma-chan", 8 << d
->dshift
);
542 memory_region_add_subregion(isa_address_space_io(isa
),
543 d
->base
, &d
->channel_io
);
545 isa_register_portio_list(isa
, d
->page_base
, page_portio_list
, d
,
547 if (d
->pageh_base
>= 0) {
548 isa_register_portio_list(isa
, d
->pageh_base
, pageh_portio_list
, d
,
552 memory_region_init_io(&d
->cont_io
, OBJECT(isa
), &cont_io_ops
, d
,
553 "dma-cont", 8 << d
->dshift
);
554 memory_region_add_subregion(isa_address_space_io(isa
),
555 d
->base
+ (8 << d
->dshift
), &d
->cont_io
);
557 for (i
= 0; i
< ARRAY_SIZE(d
->regs
); ++i
) {
558 d
->regs
[i
].transfer_handler
= i8257_phony_handler
;
561 d
->dma_bh
= qemu_bh_new(i8257_dma_run
, d
);
564 static Property i8257_properties
[] = {
565 DEFINE_PROP_INT32("base", I8257State
, base
, 0x00),
566 DEFINE_PROP_INT32("page-base", I8257State
, page_base
, 0x80),
567 DEFINE_PROP_INT32("pageh-base", I8257State
, pageh_base
, 0x480),
568 DEFINE_PROP_INT32("dshift", I8257State
, dshift
, 0),
569 DEFINE_PROP_END_OF_LIST()
572 static void i8257_class_init(ObjectClass
*klass
, void *data
)
574 DeviceClass
*dc
= DEVICE_CLASS(klass
);
576 dc
->realize
= i8257_realize
;
577 dc
->reset
= i8257_reset
;
578 dc
->vmsd
= &vmstate_i8257
;
579 dc
->props
= i8257_properties
;
582 static const TypeInfo i8257_info
= {
584 .parent
= TYPE_ISA_DEVICE
,
585 .instance_size
= sizeof(I8257State
),
586 .class_init
= i8257_class_init
,
589 static void i8257_register_types(void)
591 type_register_static(&i8257_info
);
594 type_init(i8257_register_types
)
596 void DMA_init(ISABus
*bus
, int high_page_enable
)
598 ISADevice
*isa1
, *isa2
;
601 isa1
= isa_create(bus
, TYPE_I8257
);
603 qdev_prop_set_int32(d
, "base", 0x00);
604 qdev_prop_set_int32(d
, "page-base", 0x80);
605 qdev_prop_set_int32(d
, "pageh-base", high_page_enable
? 0x480 : -1);
606 qdev_prop_set_int32(d
, "dshift", 0);
608 dma_controllers
[0] = I8257(d
);
610 isa2
= isa_create(bus
, TYPE_I8257
);
612 qdev_prop_set_int32(d
, "base", 0xc0);
613 qdev_prop_set_int32(d
, "page-base", 0x88);
614 qdev_prop_set_int32(d
, "pageh-base", high_page_enable
? 0x488 : -1);
615 qdev_prop_set_int32(d
, "dshift", 1);
617 dma_controllers
[1] = I8257(d
);