wb.c

这是Skyeye 0.9 版本的源代码

#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--;
    };
}