function-instr.c

#include "main-header.h"
#include "constants.h"
#include "loader-api.h"
#include "function-instr.h"
 
static byte pc_listing_enabled = 0;
 
void __cyg_profile_func_enter(void *func, void *callsite) __attribute__((no_instrument_function));
void __cyg_profile_func_exit(void *func, void *callsite) __attribute__((no_instrument_function));
volatile byte overflow_check_active;
extern void *_Stack_Limit;
static struct traceinfo mytraceinfo;
void stack_overflow(void *sp)  __attribute__((no_instrument_function));
 
void __cyg_profile_func_enter(void *func, void *callsite) {
  byte spb;
 
  if (!pc_listing_enabled) {
    return;
  }
  //constants()->last_function = func;
  constants()->last_return_address = __builtin_return_address(0);
  if (!overflow_check_active) {
    return;
  }
  // if address of spb < stack_limit, we got a problem...
  if (((void *)(&spb)) < ((void *)(&_Stack_Limit))) {
    stack_overflow(&spb);
  }
}
void __cyg_profile_func_exit(void *func, void *callsite) {
}
 
void stack_overflow(void *sp) {
  overflow_check_active = 0;
  printf("A stack overflow has been detected (sp=%p, limit=%p).\r\n", sp, &_Stack_Limit);
  printf("Return Address: %p\r\n", constants()->last_return_address);
  long l = mculib_get_seconds_since_boot();
 
  while ((mculib_get_seconds_since_boot() - l) < 3) {
    ;;
  }
  printf("Reseting application\r\n");
  restart_app();
}
 
void enable_pc_tracing() {
  pc_listing_enabled = 1;
}
 
struct traceinfo *get_reboot_info() {
  return &mytraceinfo;
}