Subversion Repositories shark

/*
 * Project: S.Ha.R.K.
 *
 * Coordinators: 
 *   Giorgio Buttazzo    <giorgio@sssup.it>
 *   Paolo Gai           <pj@gandalf.sssup.it>
 *
 * Authors     : 
 *   Paolo Gai           <pj@gandalf.sssup.it>
 *   (see the web pages for full authors list)
 *
 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)
 *
 * http://www.sssup.it
 * http://retis.sssup.it
 * http://shark.sssup.it
 */

/**
 ------------
 CVS :        $Id: exchand.c,v 1.3 2004-02-10 17:50:03 giacomo Exp $

 File:        $File$
 Revision:    $Revision: 1.3 $
 Last update: $Date: 2004-02-10 17:50:03 $
 ------------
**/

/*
 * Copyright (C) 2000-2003 Paolo Gai
 *
 * This program 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 of the License, or
 * (at your option) any later version.
 *
 * This program 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 this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 */

#include <kernel/kern.h>
#include <stdlib.h>
#include <tracer.h>

static int             myflag;
static siginfo_t       myinfo;
static struct timespec mytime;

static void thehandler(int signo, siginfo_t *info, void *extra);
static void theend(void *arg);

const char *const _sys_exclist[] = {
  "not used",
  "not used",
  "invalid kill of a task with a shadow pointer set",          /* 2 */
  "cleanup push: no more cleanups handlers",
  "invalid operation for a task",
  "not used",
  "no more OSLib events posted (see oslib/kl/event.c)",
  "deadline miss",
  "wcet violation",
  "task activated at a wrong time (too early?)",
  "mutex owner killed",                                        /* 10 */
  "SRP: invalid lock",
  "Dummy task: invalid operation",
  "Sporadic Server: invalid replenishment",
  "ARP: table full",
  "Netbuff: init",
  "Netbuff: get",
  "Netbuff: already free",
  "Netbuff: release",
  "UDP: Bad checksum"
};

static char shutdown_message_buffer[500];
static int myflag_shutdown = 0;

/*
   This exception handler should be good for text applications that do NOT
   use graphics
*/
int set_default_exception_handler(void)
{
  struct sigaction action;

  myflag = 0;

  sys_atrunlevel(theend, NULL, RUNLEVEL_AFTER_EXIT);

  /* Init the standard S.Ha.R.K. exception handler */
  action.sa_flags = SA_SIGINFO;            /* Set the signal action */
  action.sa_sigaction = thehandler;
  action.sa_handler = 0;
  sigfillset(&action.sa_mask); /* we block all the other signals... */

  return sigaction(SIGHEXC, &action, NULL); /* set the signal */
}

int sys_shutdown_message(char *fmt,...)
{
  va_list parms;
  int result = -1;
  
  if (!myflag_shutdown) {
    myflag_shutdown = 1;
    va_start(parms,fmt);
    result = vsprintf(shutdown_message_buffer,fmt,parms);
    va_end(parms);
  }
  
  return(result);
}

static void thehandler(int signo, siginfo_t *info, void *extra)
{
  if (!myflag) {
    myflag = 1;
    myinfo = *info;
    sys_gettime(&mytime),

    sys_abort(AHEXC);
  }
}


extern void *StartTracerBuffer; // Buffer Start 0
extern void *EndTracerBuffer; // Buffer End 4
extern void *LastBeforeEndTracerBuffer; //8
extern void *CurrentTracerBuffer; //The Actual Write Point For The Next Event 12
extern void *FirstTracerBuffer; //The First Valid Event 16
                                                                                                                             
                                                                                                                             
extern int TracerActive; //20
extern int TracerOutputType; //24
extern unsigned long long TracerEventsRecorded; //28
extern unsigned int TracerEventsPresent; //36

static void theend(void *arg)
{

  #ifdef __NEW_TRACER__
 
    void *save_tracer_pointer;
 
  #endif

  if (myflag) {
    cprintf("S.Ha.R.K. Exception raised!!!\n");
    cprintf("Time (s:ns)     :%ld:%ld\n", mytime.tv_sec, mytime.tv_nsec);
    cprintf("Exception number:%d (%s)\n", myinfo.si_value.sival_int, 
            _sys_exclist[myinfo.si_value.sival_int]);
    cprintf("PID             :%d (%s)\n", myinfo.si_task, 
            proc_table[myinfo.si_task].name);
    cprintf("Avail time      : %d\n", proc_table[myinfo.si_task].avail_time);
    
    #ifdef __NEW_TRACER__

      save_tracer_pointer = malloc(48);
      
      *(void **)(save_tracer_pointer) = StartTracerBuffer; // Buffer Start 0
      *(void **)(save_tracer_pointer+4) = EndTracerBuffer; // Buffer End 4
      *(void **)(save_tracer_pointer+8) = LastBeforeEndTracerBuffer; //8
      *(void **)(save_tracer_pointer+12) = CurrentTracerBuffer; //The Actual Write Point For The Next Event 12
      *(void **)(save_tracer_pointer+16) = FirstTracerBuffer; //The First Valid Event 16
                                                                                                                             
      *(int *)(save_tracer_pointer+20) = 0; //20
 
      *(int *)(save_tracer_pointer+24) = TRACER_UDP_OUTPUT; //24
      *(unsigned long long *)(save_tracer_pointer+28) = TracerEventsRecorded; //28
      *(unsigned int *)(save_tracer_pointer+36) = TracerEventsPresent; //36 

      cprintf("Dumper Magic Number = %u\n",(int)save_tracer_pointer);

    #endif

  }
  if (myflag_shutdown) {
    cprintf("\nShutdown message:\n%s\n", shutdown_message_buffer);
  }

}