//==========================================================================
//
//      bplist-dynamic.c
//
//      Breakpoint list using dynamic memory.
//
//==========================================================================
// ####ECOSGPLCOPYRIGHTBEGIN####                                            
// -------------------------------------------                              
// This file is part of eCos, the Embedded Configurable Operating System.   
// Copyright (C) 1998, 1999, 2000, 2001, 2002 Free Software Foundation, Inc.
//
// eCos is free software; you can redistribute it and/or modify it under    
// the terms of the GNU General Public License as published by the Free     
// Software Foundation; either version 2 or (at your option) any later      
// version.                                                                 
//
// eCos is distributed in the hope that it will be useful, but WITHOUT      
// ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or    
// FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License    
// for more details.                                                        
//
// You should have received a copy of the GNU General Public License        
// along with eCos; if not, write to the Free Software Foundation, Inc.,    
// 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.            
//
// As a special exception, if other files instantiate templates or use      
// macros or inline functions from this file, or you compile this file      
// and link it with other works to produce a work based on this file,       
// this file does not by itself cause the resulting work to be covered by   
// the GNU General Public License. However the source code for this file    
// must still be made available in accordance with section (3) of the GNU   
// General Public License v2.                                               
//
// This exception does not invalidate any other reasons why a work based    
// on this file might be covered by the GNU General Public License.         
// -------------------------------------------                              
// ####ECOSGPLCOPYRIGHTEND####                                              
//==========================================================================
//#####DESCRIPTIONBEGIN####
//
// Author(s):    
// Contributors: gthomas
// Date:         1999-10-20
// Purpose:      Breakpoint list using dynamic memory.
// Description:  
//               
//
//####DESCRIPTIONEND####
//
//=========================================================================

#include "board.h"

#ifndef USE_ECOS_HAL_BREAKPOINTS

#include <stdlib.h>

#ifndef NO_MALLOC
#ifndef NO_MALLOC_H
#include "malloc.h"
#else
void free ();
char *malloc ();
#endif
#endif

#ifdef __ECOS__
#include <cyg/hal/plf_stub.h>
#endif /* __ECOS__ */

/*
 * A simple target breakpoint list using malloc.
 * To use this package, you must define TRAP_SIZE to be the size
 * in bytes of a trap instruction (max if there's more than one),
 * and export a char array called _breakinst that contains a
 * breakpoint trap.  This package will copy trap instructions
 * from _breakinst into the breakpoint locations.
 */

static struct breakpoint_list {
  target_register_t  addr;
  char old_contents [TRAP_SIZE];
  struct breakpoint_list *next;
  char in_memory;
} *breakpoint_list = NULL;

#ifdef NO_MALLOC
static struct breakpoint_list bp_list [MAX_BP_NUM];
static struct breakpoint_list *free_bp_list = NULL;
static int curr_bp_num = 0;
#endif

#ifndef BREAKINST_DEFINED
#define BREAKINST_DEFINED
extern unsigned char _breakinst[];
#endif

int
__set_breakpoint (target_register_t addr)
{
  struct breakpoint_list **addent = &breakpoint_list;
  struct breakpoint_list *l = breakpoint_list;
  struct breakpoint_list *newent;

  while (l != NULL && l->addr < addr)
    {
      addent = &l->next;
      l =  l->next;
    }

  if (l != NULL && l->addr == addr)
    return 2;

#ifdef NO_MALLOC
  if (free_bp_list != NULL)
    {
      newent = free_bp_list;
      free_bp_list = free_bp_list->next;
    }
  else
    {
      if (curr_bp_num < MAX_BP_NUM)
	{
	  newent = &bp_list[curr_bp_num++];
	}
      else
	{
	  return 1;
	}
    }
#else
  newent = (struct breakpoint_list *) malloc (sizeof (struct breakpoint_list));
#endif
  newent->addr = addr;
  newent->in_memory = 0;
  newent->next = l;
  *addent = newent;
  return 0;
}

int
__remove_breakpoint (target_register_t addr)
{
  struct breakpoint_list *l = breakpoint_list;
  struct breakpoint_list *prev = NULL;

  while (l != NULL && l->addr < addr)
    {
      prev = l;
      l = l->next;
    }

  if (l == NULL)
    return 1;

  if (l->in_memory)
    {
      __write_mem_safe (&l->old_contents[0],
			(void*)l->addr,
			sizeof (l->old_contents));
    }

  if (prev == NULL)
    breakpoint_list = l->next;
  else
    prev->next = l->next;

#ifdef NO_MALLOC
  l->next = free_bp_list;
  free_bp_list = l;
#else
  free (l);
#endif
  return 0;
}

#include <cyg/hal/generic-stub.h>
#include <cyg/hal/hal_stub.h>
void
__cygmon_install_breakpoints (void)
{
  struct breakpoint_list *l = breakpoint_list;

  while (l != NULL)
    {
      if (! l->in_memory)
	{
	  int len = sizeof (l->old_contents);

	  if (__read_mem_safe (&l->old_contents[0], (void*)l->addr, len) == len)
	    {
#ifdef WRITE_MEM_IS_MEMCPY
	      if (__write_mem_safe (_breakinst, (void*)l->addr, len) == (void*)l->addr)
#else
	      if (__write_mem_safe (_breakinst, (void*)l->addr, len) == len)
#endif
		{
		  l->in_memory = 1;
		}
	    }
	}
      l = l->next;
    }
  flush_i_cache ();
}

void
__cygmon_clear_breakpoints (void)
{
  struct breakpoint_list *l = breakpoint_list;

  while (l != NULL)
    {
      if (l->in_memory)
	{
	  int len = sizeof (l->old_contents);

#ifdef WRITE_MEM_IS_MEMCPY
      if (__write_mem_safe (_breakinst, (void*)l->addr, len) == (void*)l->addr)
#else
	  if (__write_mem_safe (&l->old_contents[0], (void*)l->addr, len) == len)
#endif
	    {
	      l->in_memory = 0;
	    }
	}
      l = l->next;
    }
  flush_i_cache ();
}

#endif // USE_ECOS_HAL_BREAKPOINTS
