Subversion Repositories openrisc

//==========================================================================
//
//      breakpoints.c
//
//      Support aribtrary set of breakpoints.
//
//==========================================================================
// ####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:      
// Description:  
//               
//
//####DESCRIPTIONEND####
//
//=========================================================================
 
#include "board.h"
 
#ifndef USE_ECOS_HAL_BREAKPOINTS
 
#include <stdlib.h>
#ifdef HAVE_BSP
#include <bsp/bsp.h>
#include <bsp/cpu.h>
#endif
 
#include "monitor.h"
#include "tservice.h"
#include "stub-tservice.h"
 
#include "fmt_util.h"
 
 
static struct bp *last_bp_ptr;
static struct bp *first_bp_ptr;
 
#ifdef NO_MALLOC
static struct bp *free_bp_list;
static struct bp bp_list[MAX_NUM_BP];
static int       curr_bp_num;
#endif
 
int
add_mon_breakpoint (mem_addr_t location)
{
  struct bp *ptr;
  struct bp *new_bp_ptr;
 
  for (ptr = first_bp_ptr; ptr != NULL; ptr = ptr->next)
    {
      if (MEM_ADDR_EQ_P (ptr->address, location))
	return 1;
    }
#ifdef NO_MALLOC
  if (free_bp_list != NULL)
    {
      new_bp_ptr = free_bp_list;
      free_bp_list = new_bp_ptr->next;
    }
  else
    {
      if (curr_bp_num < MAX_NUM_BP)
	{
	  new_bp_ptr = &bp_list[curr_bp_num++];
	}
      else
	{
	  xprintf ("No more breakpoints\n");
	  return 1;
	}
    }
#else
  new_bp_ptr = (struct bp *)malloc (sizeof (struct bp));
#endif
 
  if (first_bp_ptr == NULL)
    {
      first_bp_ptr = new_bp_ptr;
    }
  else
    {
      last_bp_ptr->next = new_bp_ptr;
    }
  last_bp_ptr = new_bp_ptr;
 
  last_bp_ptr->next = NULL;
  last_bp_ptr->address = location;
  last_bp_ptr->in_memory = 0;
  return 0;
}
 
 
void
install_breakpoints (void)
{
  struct bp *ptr = first_bp_ptr;
  while (ptr != NULL)
    {
      set_breakpoint (ptr);
      ptr = ptr->next;
    }
}
 
 
void
clear_breakpoints (void)
{
  struct bp *ptr = first_bp_ptr;
 
  while (ptr != NULL)
    {
      clear_breakpoint (ptr);
      ptr = ptr->next;
    }
}
 
int
show_breakpoints (void)
{
  struct bp *ptr;
 
  for (ptr = first_bp_ptr; ptr != NULL; ptr = ptr->next)
    {
      char buf[20];
 
      addr2str (&ptr->address, buf);
      xprintf ("%s\n", buf);
    }
 
  return 0;
}
 
 
 
int 
clear_mon_breakpoint (mem_addr_t location)
{
  int error = 0;
  struct bp *ptr = first_bp_ptr;
  struct bp *prev_ptr = NULL;
 
  /* Scan the list looking for the address to clear */
  while (ptr != NULL && !MEM_ADDR_EQ_P (ptr->address, location))
    {
      /* keep a pointer one behind the current position */
      prev_ptr = ptr;
      ptr = ptr->next;
    }
  if (ptr == NULL)
    {
      xprintf ("That address has no breakpoint on it.\n");
      error = 1;
    }
  else
    {
      /* Just in case it's still in memory. */
      clear_breakpoint (ptr);
 
      /* now we'll point the previous bp->next at the one after the one 
	 we're deleting, unless there is no previous bp. */
      if (prev_ptr != NULL)
	{
	  prev_ptr->next = ptr->next;
	}
 
      if (first_bp_ptr == ptr)
	first_bp_ptr = ptr->next;
 
      if (last_bp_ptr == ptr)
	last_bp_ptr = prev_ptr;
 
      /* eliminate the offending bp struct */
#ifdef NO_MALLOC
      ptr->next = free_bp_list;
      free_bp_list = ptr;
#else
      free (ptr);
#endif
    }
  return error;
}	
 
#endif /* USE_ECOS_HAL_BREAKPOINTS */