rb.c

模拟嵌入式硬件平台的软件源代码

#include "armdefs.h"
/*chy 2004-06-06, fix bug found by [e-mail]*/
ARMword rb_masks[] = {
	0x0,	//RB_INVALID
	4,	//RB_1
	16,	//RB_4
	32,	//RB_8
};

/*mmu_rb_init
 * @rb_t	:rb_t to init
 * @num		:number of entry
 * */
int
mmu_rb_init(rb_t *rb_t, int num)
{
	int i;
	rb_entry_t *entrys;

	entrys = (rb_entry_t *)malloc(sizeof(*entrys) * num);
	if (entrys == NULL){
		printf("SKYEYE:mmu_rb_init malloc error\n");
		return -1;
	}
	for (i = 0; i < num; i++){
		entrys[i].type = RB_INVALID;
		entrys[i].fault = 0;
	}
	
	rb_t->entrys = entrys;
	rb_t->num = num;
	return 0;
}

/*mmu_rb_exit*/
void
mmu_rb_exit(rb_t *rb_t){
	free(rb_t->entrys);
};

/*mmu_rb_search
 * @rb_t	:rb_t to serach
 * @va		:va address to math
 *
 * $	NULL :not match
 * 		NO-NULL:
 * */
rb_entry_t *
mmu_rb_search(rb_t *rb_t, ARMword va)
{
	int i;
	rb_entry_t *rb = rb_t->entrys;

	d_msg("va = %x\n", va);
	for (i = 0; i < rb_t->num; i++, rb++){
		//2004-06-06 lyh  bug from [e-mail]
		if (rb->type){
			if ((va >= rb->va) && (va < (rb->va + rb_masks[rb->type])))
				return rb;
		}
	}
	return NULL;
};

void
mmu_rb_invalidate_entry(rb_t *rb_t, int i)
{
	rb_t->entrys[i].type = RB_INVALID;
}

void
mmu_rb_invalidate_all(rb_t *rb_t)
{
	int i;

	for (i = 0; i < rb_t->num; i++)
		mmu_rb_invalidate_entry(rb_t, i);
};

void
mmu_rb_load(ARMul_State *state, rb_t *rb_t, int i_rb, int type, ARMword va)
{
	rb_entry_t *rb;
	int i;
	ARMword max_start, min_end;
	fault_t	fault;
	tlb_entry_t *tlb;

	/*align va according to type*/
	va &= ~(rb_masks[type] - 1);
	/*invalidate all RB match [va, va + rb_masks[type]]*/
	for (rb = rb_t->entrys, i = 0; i < rb_t->num; i++, rb++){
		if (rb->type){
			max_start = max(va, rb->va);
			min_end = min(va + rb_masks[type], rb->va + rb_masks[rb->type]);
			if (max_start < min_end)
				rb->type = RB_INVALID;
		}
	}
	/*load word*/
	rb = &rb_t->entrys[i_rb];
	rb->type = type;
	fault = translate(state, va, D_TLB(), &tlb);
	if (fault){
		rb->fault = fault;
		return;
	}
	fault = check_access(state, va, tlb, 1);
	if (fault){
		rb->fault = fault;
		return;
	}

	rb->fault = 0;
	va = tlb_va_to_pa(tlb, va);
	//2004-06-06 lyh  bug from [e-mail]
	for (i = 0; i < (rb_masks[type]/4); i++, va+= WORD_SIZE){
		rb->data[i] = mem_read_word(state, va);
	};
}