Subversion Repositories shark

/* Project:     HARTIK 3.0                                      */

/* Description: Hard Real TIme Kernel for 386 & higher machines */

/* Author:      Paolo Gai <pgai@rsk.it>                         */

/*              Advanced Linux Sound Architecture (ALSA)        */

/*              Copyright (c) by Jaroslav Kysela <perex@jcu.cz> */

/*              Luca Abeni                                      */

/*              FFTW by M. Frigo and S. G. Johnson              */

/* Date:        08/09/1999                                      */

/* File:        fftplay.c                                       */

/* Revision:    1.00 (Kernel 0.1.4; Library 0.0.9; Util 0.0.4)  */

#include "demo.h"

//#include <kernel/types.h>

//#include <kernel/model.h>

#include <kernel/func.h>

//#include <modules/cabs.h>

#include <string.h>

#include <stdlib.h>

#include <drivers/keyb.h>

//#include <drivers/crtwin.h>

#include <drivers/glib.h>

//#include <drivers/sound.h>

//#include <ports/rfftw.h>

/* Informations about the sampling rate and buffers */

WORD rawdata_nsamples;

WORD rawdata_buffer_size;

WORD rawdata_freq;

/* graphic mutex... */

mutex_t mutex;

/* useful colors... */

int white;

int black;

int red;

int gray;

void app_mutex_init(mutex_t *m);

static void version( void )

{

  cprintf( "Hartik FFT Play 1.0\n"     );

  cprintf( "-----------------------\n" );

  cprintf( "by Paolo Gai 1999\n"       );

  cprintf( "   <pj@hartik.sssup.it>\n" );

  cprintf( "-----------------------\n" );

}

void reverse(char s[])

{

  int c, i, j;

  for (i = 0, j = strlen(s)-1; i<j; i++, j--)

  {

    c = s[i];

    s[i] = s[j];

    s[j] = c;

  }

}

char * itoa(int n, char *s)

{

  int i, sign;

  if ((sign = n) < 0)

    n = -n;

  i = 0;

  do

  {

    s[i++] = n % 10 + '0';

  } while ((n /= 10) > 0);

  if (sign < 0)

    s[i++] = '-';

  s[i] = 0;

  reverse(s);

  return s;

}

void display_jet(PID i)

{

  char st[200];

  TIME sum, max;

  int n;

  if (jet_getstat(i, &sum, &max, &n, NULL) != -1) {

    if (n==0) n=1;

    sprintf(st, "PID=%2d st=%3d Mean=%5d Max=%5d na=%10s",

                (int)i,

                (int)proc_table[i].status, (int)sum/n, (int)max,

                proc_table[i].name);

    mutex_lock(&mutex);

    grx_text(st, 0, 400+i*8, 255, 0);

    mutex_unlock(&mutex);

  }

}

void scenario(int f)

{

  grx_text("HARTIK 4.0 - LEGO Version"    , 0,0, rgb16(0,255,0), black );

  grx_text("Thesis Demo", 0,8, rgb16(0,255,0), black );

  #ifdef FFT_ON

  scenario_fftplay(f);

  #endif

  #ifdef FRAMEGRABBER_ON

  scenario_framegrabber();

  #endif

  #ifdef JET_ON

  scenario_jetcontrol();

  #endif

  #ifdef BALL_ON

  scenario_ball();

  #endif

}

void demo_exc_handler(int signo, siginfo_t *info, void *extra)

{

  struct timespec t;

  grx_close();

  /* Default action for an kern exception is  */

  kern_cli();

  ll_gettime(TIME_EXACT, &t),

  kern_printf("\nHartik Exception raised!!!"

            "\nTime (s:ns)     :%ld:%ld"

            "\nException number:%d"

            "\nPID             :%d\n",

            t.tv_sec, t.tv_nsec, info->si_value.sival_int,

            info->si_task);

  sys_end();

//  ll_abort(5);

}

void my_close(void *arg)

{

        grx_close();

//        sys_status(3);

}

void endfun(KEY_EVT *k)

{

    grx_close();

    cprintf("Ctrl-Brk pressed! Ending...\n");

    sys_end();

}

void zerofun(KEY_EVT *k)

{

  int i;

  for (i=0; i<MAX_PROC; i++) jet_delstat(i);

}

void printeventqueue(void *arg)

{

  struct event *p;

  extern struct event *firstevent;

  kern_cli();

  grx_close();

  kern_cli();

  for (p = firstevent; p != NULL; p = p->next) {

    kern_printf("par:%d time:%ld.%ld p:%d handler:%d\n",

        (int)p->par, p->time.tv_sec, p->time.tv_nsec/1000, (int)p, (int)p->handler);

  }

  kern_sti();

}

int main(int argc, char **argv)

{

    int modenum;

    int f;

    KEY_EVT k;

    struct sigaction action;

    srand(4);

    version();

    #ifdef FRAMEGRABBER_ON

    if (argc == 1)

    {

      cprintf("type x fftplay <freq>");

      return 0;

    }

    f = atoi(argv[1]);

    compute_params(&f,&rawdata_nsamples);

    #endif

    keyb_set_map(itaMap);

    k.flag = CNTR_BIT;

    k.scan = KEY_C;

    k.ascii = 'c';

    keyb_hook(k,endfun);

    k.flag = CNTL_BIT;

    k.scan = KEY_C;

    k.ascii = 'c';

    keyb_hook(k,endfun);

    k.flag = ALTL_BIT;

    k.scan = KEY_C;

    k.ascii = 'c';

    keyb_hook(k,zerofun);

    k.flag = 0;

    k.scan = KEY_ENT;

    k.ascii = 13;

    keyb_hook(k,endfun);

    /* Init the standard Hartik exception handler */

    /* Set the signal action */

    action.sa_flags = SA_SIGINFO;

    action.sa_sigaction = demo_exc_handler;

    action.sa_handler = 0;

    sigfillset(&action.sa_mask); /* we block all the other signals... */

    if (sigaction(SIGHEXC, &action, NULL) == -1) {

      perror("Error initializing signals...");

      sys_end();

    }

    sys_atrunlevel(my_close, NULL, RUNLEVEL_BEFORE_EXIT);

    grx_init();

    modenum = grx_getmode(640, 480, 16);

    grx_setmode(modenum);

    /* init the graphic mutex */

    app_mutex_init(&mutex);

    /* useful colors ... */

    white = rgb16(255,255,255);

    black = rgb16(0,0,0);

    red   = rgb16(255,0,0);

    gray  = rgb16(128,128,128);

    scenario(f/2);

//    grx_close();

//    clear();

    #ifdef FFT_ON

    init_fftplay(f);

    #endif

    #ifdef FRAMEGRABBER_ON

    init_framegrabber();

    #endif

    #ifdef JET_ON

    init_jetcontrol();

    #endif

    #ifdef BALL_ON

    init_ball();

    #endif

    group_activate(1);

    #ifdef FRAMEGRABBER_ON

    start_framegrabber();

    #endif

    return 0;

}