wb.c

skyeye是一个可以模拟嵌入式硬件开发板的系统软件

#include "armdefs.h"

/* wb_init
 * @wb_t	:wb_t to init
 * @num		:num of entrys
 * @nb		:num of byte of each entry
 *
 * $	-1:error
 * 		 0:ok
 * */
int
mmu_wb_init (wb_t * wb_t, int num, int nb)
{
	int i;
	wb_entry_t *entrys, *wb;

	entrys = (wb_entry_t *) malloc (sizeof (*entrys) * num);
	if (entrys == NULL) {
		err_msg ("malloc size %d\n", sizeof (*entrys) * num);
		goto entrys_malloc_error;
	}

	for (wb = entrys, i = 0; i < num; i++, wb++) {
		/*chy 2004-06-06, fix bug found by [e-mail] */
		//wb->data = (ARMword *)malloc(sizeof(ARMword) * nb);
		wb->data = (ARMword *) malloc (nb);
		if (wb->data == NULL) {
			err_msg ("malloc size of %d\n", nb);
			goto data_malloc_error;
		}

	};

	wb_t->first = wb_t->last = wb_t->used = 0;
	wb_t->num = num;
	wb_t->nb = nb;
	wb_t->entrys = entrys;
	return 0;

      data_malloc_error:
	while (--i >= 0)
		free (entrys[i].data);
	free (entrys);
      entrys_malloc_error:
	return -1;
};

/* wb_exit
 * @wb_t :wb_t to exit
 * */
void
mmu_wb_exit (wb_t * wb_t)
{
	int i;
	wb_entry_t *wb;

	wb = wb_t->entrys;
	for (i = 0; i < wb_t->num; i++, wb++) {
		free (wb->data);
	}
	free (wb_t->entrys);
};

/* wb_write_words :put words in Write Buffer
 * @state:	ARMul_State
 * @wb_t:	write buffer
 * @pa:		physical address
 * @data:	data ptr
 * @n		number of word to write
 *
 * Note: write buffer merge is not implemented, can be done late
 * */
void
mmu_wb_write_bytes (ARMul_State * state, wb_t * wb_t, ARMword pa,
		    ARMbyte * data, int n)
{
	int i;
	wb_entry_t *wb;

	while (n) {
		if (wb_t->num == wb_t->used) {
			/*clean the last wb entry */
			ARMword t;

			wb = &wb_t->entrys[wb_t->last];
			t = wb->pa;
			for (i = 0; i < wb->nb; i++) {
				mem_write_byte (state, t, wb->data[i]);
				//t += WORD_SIZE;
				t++;
			}
			wb_t->last++;
			if (wb_t->last == wb_t->num)
				wb_t->last = 0;
			wb_t->used--;
		}

		wb = &wb_t->entrys[wb_t->first];
		i = (n < wb_t->nb) ? n : wb_t->nb;

		wb->pa = pa;
		//pa += i << WORD_SHT;
		pa += i;

		wb->nb = i;
		//memcpy(wb->data, data, i << WORD_SHT);
		memcpy (wb->data, data, i);
		data += i;
		n -= i;
		wb_t->first++;
		if (wb_t->first == wb_t->num)
			wb_t->first = 0;
		wb_t->used++;
	};
//teawater add for set_dirty fflash cache function 2005.07.18-------------------
#ifndef NO_DBCT
	if (!skyeye_config.no_dbct) {
		tb_setdirty (state, pa, NULL);
	}
#endif
//AJ2D--------------------------------------------------------------------------
}

/* wb_drain_all
 * @wb_t wb_t to drain
 * */
void
mmu_wb_drain_all (ARMul_State * state, wb_t * wb_t)
{
	ARMword pa;
	wb_entry_t *wb;
	int i;

	while (wb_t->used) {
		wb = &wb_t->entrys[wb_t->last];
		pa = wb->pa;
		for (i = 0; i < wb->nb; i++) {
			mem_write_byte (state, pa, wb->data[i]);
			//pa += WORD_SIZE;
			pa++;
		}
		wb_t->last++;
		if (wb_t->last == wb_t->num)
			wb_t->last = 0;
		wb_t->used--;
	};
}