handler.c

#define DEBUG 0
#define INFO  0

#include <rtems/l4vcpu/handler.h>
#include <rtems/l4vcpu/l4thread.h>
#include <rtems/l4vcpu/l4kdebug.h>
#include <rtems/l4vcpu/l4util.h>
#include <rtems/l4vcpu/l4rtems_wrapper.h>
#include <bsp/irq-generic.h>
#include "l4lib.h"

#include <stdio.h>

unsigned long __l4_external_resolver;

L4_EXTERNAL_FUNC(l4rtems_requestIrq);
L4_EXTERNAL_FUNC(l4rtems_detachIrq);
L4_EXTERNAL_FUNC(l4rtems_timer_start);
L4_EXTERNAL_FUNC(l4rtems_timer_stop);
L4_EXTERNAL_FUNC(l4rtems_timer_read);

static unsigned long fs, ds;
static l4_vcpu_state_t *vcpuh;
extern sharedvars_t* sharedVariableStruct;
  
void
handler_prolog( void )
{ /* handler_prolog: recover the saved host fs & ds */
  fs = sharedVariableStruct->ufs;
  ds = sharedVariableStruct->uds;
#if DEBUG
  printk( "fs: %x\n", fs);
//  enter_kdebug( "handler prolog" );
#endif
  asm volatile( 
      " mov %0, %%es \t\n"
      " mov %0, %%ds \t\n"
      " mov %1, %%fs \t\n"
      : : "r"(ds),"r"(fs) );
}



l4_fastcall void
l4rtems_handler( l4_vcpu_state_t* vcpuh ) 
{ /* This handler is invoked, if the guest system suffers a page fault or an
     interrupt. The handler checks the entry reason, and replies with an 
     apropriate action. */
#if DEBUG
  printk("Hello Handler\n");
#endif
  if( vcpuh == NULL )
    vcpuh = sharedVariableStruct->vcpu;
  handler_prolog();
  vcpuh->state &= L4_VCPU_F_EXCEPTIONS;
  
  /* checking the entry reason */

//  printk( "Handler: %i \n", vcpuh->r.trapno );
//  printk( "Handler: %x \n", vcpuh->r.ip );
  if( l4vcpu_is_page_fault_entry( vcpuh ) )
  { /* This shouldn't be happening */
    printk("page fault entry\n");
    printk( "Faulting at address: %x \n", vcpuh->r.ip );
    l4_umword_t pfnum = vcpuh->r.pfa;
    printk("pfa: %lx\n",pfnum);
    /* where do I get the snd_base? */
//    vcpu_task->map( L4Re::This_task, 
//	l4_fpage( pfnum, L4_PAGESIZE, L4_FPAGE_RWX ),
//	 0);
    printk("Handler: Page mapped\n");
    /* copied out of vcpu example: why state add? */
    vcpuh->saved_state |= L4_VCPU_F_PAGE_FAULTS ;
    printk("Handler: saved_state added\n");
    enter_kdebug("page fault entry");
  }
  else if( l4vcpu_is_irq_entry( vcpuh ) )
  {
    l4rtems_irq_handler( vcpuh );
  }
  else
  {
    //l4vcpu_print_state( vcpuh, "Handler Unknown Entry:");
    printk( "unknown entry reason! \n" );
#if !DEBUG
    printk("vcpu->trapno: %i\n", vcpuh->r.trapno);
    printk( "label: %i \n", vcpuh->i.label );
    printk( "IP: %x \n", vcpuh->r.ip );
//    printk( "%s\n", l4sys_errtostr(vcpuh->r.flags));
    enter_kdebug("handler entry");
#endif
  }

//  vcpu->print_state("resume ");
  l4_cap_idx_t self = L4_INVALID_CAP;
  l4_thread_vcpu_resume_commit( self, l4_thread_vcpu_resume_start() );

  printk("this should NOT be reached: handler.c\n");
}


void
l4rtems_irq_handler( l4_vcpu_state_t *vcpuh )
{
#if DEBUG
    printk("irq entry!\n" );
#endif
    switch( vcpuh->i.label )
    {
      default:
#if INFO
	   printk("> INFO:Passing IRQ %i on to RTEMS\n", vcpuh->i.label);
#endif
	   bsp_interrupt_handler_dispatch( vcpuh->i.label );
    }
}


void
l4rtems_setup_ipc( l4_utcb_t* utcb )
{ /* dummy function. not yet used */
  (void*) utcb;
  return;  
}