Subversion Repositories igor

#include <assert.h>
#include <stdio.h>
#include <err.h>
#include <errno.h>
#include <string.h>
 
#include "types.h"
#include "object.h"
#include "regs.h"
 
reg_t registers[N_REGS];
char status_flags[8] = { 'O', 'C', 'N', 'Z', 'B', 'U', 'U', 'U' };
 
void regs_load_from_file(char *regfile);
 
void
regs_init(char *regfile)
{
	int i;
	for (i = 0; i < N_REGS; i++)
		registers[i] = 0;
	if (regfile != NULL)
		regs_load_from_file(regfile);
}
 
void
regs_load_from_file(char *regfile)
{
	FILE *f = fopen(regfile, "r");
	if (f == NULL)
		errx(1, "could not open register file %s: %s",
		     regfile, strerror(errno));
 
	if (!object_read(registers, N_REGS, f))
		errx(1, "error reading register file %s: %s",
		     regfile, strerror(errno));
 
	printf("0x%X register objects read from %s\n",
	       N_REGS, regfile);
 
	fclose(f);
}
 
void
reg_set(int reg, reg_t value)
{
	assert(reg >= 0 && reg < N_REGS);
	registers[reg] = value;
}
 
reg_t
reg_get(int reg)
{
	assert(reg >= 0 && reg < N_REGS);
	return registers[reg];
}
 
 
void
reg_dump(void)
{
	printf("Dumping registers:\n");
	for (int i = 0; i < N_REGS; i++) {
		printf("\tr%d: ", i);
		object_dump(registers[i]);
	}
}
 
 
int
get_status_flag(int flag)
{
	return (reg_get(REG_ST) >> flag) & 0x1;
}
 
void
set_status_flag(int flag, int value)
{
	reg_t stval;
	if (value != 0 && value != 1)
		errx(1, "Tried to set status flag %d to %d\n", flag, value);
	stval = reg_get(REG_ST);
	if (value)
		stval |= 1<<flag;
	else
		stval &= ~(1<<flag);
	reg_set(REG_ST, stval);
}
 
int
get_all_status_flags(void)
{
	return object_get_datum(reg_get(REG_ST));
}
 
int
get_flags(uint16_t mask)
{
	uint16_t masked_flags;
	masked_flags = mask & OBJECT_DATUM(reg_get(REG_ST));
	printf("get_flags: mask=%X, masked_flags=%X\n", mask, masked_flags);
	return (masked_flags != 0 ? 1 : 0);
}