85 lines
1.2 KiB
C
85 lines
1.2 KiB
C
#include "vdc.h"
|
|
|
|
|
|
inline void vdc_reg(VDCRegister reg)
|
|
{
|
|
vdc.addr = reg;
|
|
}
|
|
|
|
inline void vdc_write(byte data)
|
|
{
|
|
do {} while (vdc.addr < 128);
|
|
vdc.data = data;
|
|
}
|
|
|
|
inline byte vdc_read(void)
|
|
{
|
|
do {} while (vdc.addr < 128);
|
|
return vdc.data;
|
|
}
|
|
|
|
|
|
void vdc_reg_write(VDCRegister reg, byte data)
|
|
{
|
|
vdc_reg(reg);
|
|
vdc_write(data);
|
|
}
|
|
|
|
byte vdc_reg_read(VDCRegister reg)
|
|
{
|
|
vdc_reg(reg);
|
|
return vdc_read();
|
|
}
|
|
|
|
|
|
void vdc_mem_addr(unsigned addr)
|
|
{
|
|
#pragma callinline()
|
|
vdc_reg_write(VDCR_ADDRH, addr >> 8);
|
|
#pragma callinline()
|
|
vdc_reg_write(VDCR_ADDRL, addr);
|
|
#pragma callinline()
|
|
vdc_reg(VDCR_DATA);
|
|
}
|
|
|
|
inline void vdc_mem_write(char data)
|
|
{
|
|
vdc_write(data);
|
|
}
|
|
|
|
inline char vdc_mem_read(void)
|
|
{
|
|
return vdc_read();
|
|
}
|
|
|
|
|
|
void vdc_mem_write_at(unsigned addr, char data)
|
|
{
|
|
#pragma callinline()
|
|
vdc_mem_addr(addr);
|
|
vdc_write(data);
|
|
}
|
|
|
|
char vdc_mem_read_at(unsigned addr)
|
|
{
|
|
#pragma callinline()
|
|
vdc_mem_addr(addr);
|
|
return vdc_read();
|
|
}
|
|
|
|
|
|
void vdc_mem_write_buffer(unsigned addr, const char * data, char size)
|
|
{
|
|
vdc_mem_addr(addr);
|
|
for(char i=0; i<size; i++)
|
|
vdc_write(data[i]);
|
|
}
|
|
|
|
void vdc_mem_read_buffer(unsigned addr, char * data, char size)
|
|
{
|
|
vdc_mem_addr(addr);
|
|
for(char i=0; i<size; i++)
|
|
data[i] = vdc_read();
|
|
}
|
|
|