/* This source file is part of the AVR Software Framework 2.0.0 release */

/*This file is prepared for Doxygen automatic documentation generation.*/
/*! \file *********************************************************************
 *
 * \brief Macros and functions dedicated to debug purposes.
 *
 * - Compiler:           IAR EWAVR32 and GNU GCC for AVR32
 * - Supported devices:  All AVR32 devices with a USART module can be used.
 *
 * \author               Atmel Corporation: http://www.atmel.com \n
 *                       Support and FAQ: http://support.atmel.no/
 *
 ******************************************************************************/

/* Copyright (c) 2009 Atmel Corporation. All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * 1. Redistributions of source code must retain the above copyright notice, this
 * list of conditions and the following disclaimer.
 *
 * 2. Redistributions in binary form must reproduce the above copyright notice,
 * this list of conditions and the following disclaimer in the documentation
 * and/or other materials provided with the distribution.
 *
 * 3. The name of Atmel may not be used to endorse or promote products derived
 * from this software without specific prior written permission.
 *
 * 4. This software may only be redistributed and used in connection with an Atmel
 * AVR product.
 *
 * THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR IMPLIED
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
 * EXPRESSLY AND SPECIFICALLY DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR
 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE
 *
 */

#include "compiler.h"
#include "debug.h"


#if (defined __GNUC__)
#   include "malloc.h"

U32 get_heap_curr_used_size( void )
{
  struct mallinfo my_info=mallinfo();
  return my_info.uordblks;
}

U32 get_heap_total_used_size( void )
{
  struct mallinfo my_info=mallinfo();
  return my_info.arena;
}
#elif (defined __ICCAVR32__)

/*
 * Include the following in the include directory path: "$TOOLKIT_DIR$\src\lib\dlib\"
 * Make sure the followings point on the malloc and free definitions.
 */
#define INCLUDE_MALLOC_PATH "..\src\lib\dlib\src\xxmemxmalloc.c"
#define INCLUDE_FREE_PATH "..\src\lib\dlib\src\xxmemxfree.c"

static size_t malloc_mem_monitor = 0;
static size_t malloc_mem_monitor_max = 0;

U32 get_heap_curr_used_size( void )
{
  return malloc_mem_monitor;
}

U32 get_heap_total_used_size( void )
{
  return malloc_mem_monitor_max;
}

// Hooks malloc function
void *malloc(size_t size)
{
  extern void *__malloc(size_t);
  void *ptr;

  ptr = __malloc(size);
  if (ptr)
  {
    malloc_mem_monitor += size;
    if (malloc_mem_monitor > malloc_mem_monitor_max)
      malloc_mem_monitor_max = malloc_mem_monitor;
  }
  return ptr;
}

// Hooks free function
void free(void *ptr)
{
  extern void __free(void *);
  static size_t get_memory_size(void *ptr);
  size_t size;

  size = get_memory_size(ptr);
  malloc_mem_monitor -= size;
  __free(ptr);
}

#define free __free
#include INCLUDE_FREE_PATH
#define malloc __malloc
#include INCLUDE_MALLOC_PATH

#define GET_PTR_ALLOC_SIZE(M, ptr, size)                        \
{                                                               \
  M##_Cell M * q;                                               \
  if (ptr == 0)                                                 \
    return 0;                                                   \
  q = (M##_Cell M *)((char M *)ptr - CELL_OFF(M));              \
  if (q->_Size < SIZE_CELL(M) || (q->_Size & M_MASK) != 0)      \
    return 0;                                                   \
  size = q->_Size;                                              \
}

static size_t get_memory_size(void *ptr)
{
  size_t size;
  GET_PTR_ALLOC_SIZE(__data32, ptr, size);
  return size;
}

#endif

U32 get_heap_free_size( void )
{
  U32 high_mark= AVR32_SRAM_SIZE;
  U32 low_mark = 0;
  U32 size ;
  void* p_mem;

  size = (high_mark + low_mark)/2;

  do
  {
    p_mem = malloc(size);
    if( p_mem != NULL)
    { // Can allocate memory
      free(p_mem);
      low_mark = size;
    }
    else
    { // Can not allocate memory
      high_mark = size;
    }

    size = (high_mark + low_mark)/2;
  }
  while( (high_mark-low_mark) >1 );

  return size;
}

static void* round_trace_pbuf;
static U32   round_trace_size;

void uc3_round_trace_init(void* buf, U32 size)
{
  round_trace_pbuf = buf;
  (*(U32*)round_trace_pbuf)=(U32)buf+4;
  round_trace_size = size;
}

void uc3_round_trace(U32 val)
{
  //Disable_global_interrupt();

  U32* p_wr = (U32*)(*(U32*)round_trace_pbuf);
  *p_wr = val;
  p_wr++;
  if( ((U32)p_wr % round_trace_size) ==0 )
    p_wr= (U32*)round_trace_pbuf+1;
  *p_wr = 0xdeadbeef;
  *(U32*)round_trace_pbuf = (U32)p_wr;

  //Enable_global_interrupt();
}

clock_t uc3_clock (void)
{
  static U32 last_time=0;
  static U32 overflow=0;
  clock_t time;

  // Get the current time.
  U32 curr_time=Get_system_register(AVR32_COUNT);

  // Track overflow situation. We made the assumtion here that we can detect 1 overflow situation.
  // This is true if the function is called faster than the overflow time.
  // For example, with a CPU at 66 MHz, you must call the function before (1<<32)/66 MHz; i.e.
  // 65 seconds since the last function call.
  if( curr_time<last_time )
     overflow++;

  // Convert the current time into absolute UC3_CLOCKS_PER_SEC ticks, given the known overflow
  // situations.
  time = (U64)(( ((U64)overflow<<32) | curr_time) * UC3_CLOCKS_PER_SEC) / get_cpu_hz();

  // Save the time for the next function call.
  last_time = curr_time;
  return time;
}
