1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
|
#include "6522.h"
#include <stdio.h>
#include <stdbool.h>
static device_vtable_t const via_6522_vtable = {
via_6522_read,
via_6522_write,
#ifdef WITH_GUI
via_6522_draw,
#endif
via_6522_deinit
};
void via_6522_init( via_6522_t *via, uint16_t addr, bool initialize )
{
device_init( &via->base, "via_6522" );
via->base.vtable = (device_vtable_t *)&via_6522_vtable;
via->addr = addr;
via->debug = false;
if( initialize ) {
via->ddra = 0x00;
}
bus_init( &via->bus );
}
void via_6522_register( via_6522_t *via, device_t *device )
{
bus_register( &via->bus, device, 0, 0 );
}
uint8_t via_6522_read( void *obj, uint16_t addr )
{
return 0;
}
void via_6522_write( void *obj, uint16_t addr, uint8_t data )
{
via_6522_t *via = (via_6522_t *)obj;
switch( addr - via->addr ) {
case DDRA:
via->ddra = data;
break;
case PORTA:
data &= via->ddra;
for( int i = 0; i < via->bus.nof_devices; i++ ) {
device_t *device = via->bus.devices[i].device;
device->vtable->write( device, 0, data );
}
break;
default:
fprintf( stderr, "ERROR: VIA 6522 not implemented address '%04X', data: '%02X'\n", addr, data );
break;
}
}
#ifdef WITH_GUI
void via_6522_draw( void *obj, SDL_Renderer *renderer )
{
via_6522_t *via = (via_6522_t *)obj;
via->bus.base.vtable->draw( &via->bus, renderer );
}
#endif
void via_6522_deinit( void *obj )
{
via_6522_t *via = (via_6522_t *)obj;
bus_deinit( &via->bus );
device_deinit( &via->base );
}
|