fputrap.cxx

C++ 编写的EROS RTOS

/*
 * Copyright (C) 1998, 1999, Jonathan S. Shapiro.
 *
 * This file is part of the EROS Operating System.
 *
 * 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,
 * 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, 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 */

/* Drivers for 386 protection faults */

#include <eros/target.h>
#include <kerninc/kernel.hxx>
#include <kerninc/Thread.hxx>
#include <kerninc/Debug.hxx>
#include <kerninc/Machine.hxx>
#include <kerninc/util.h>
#include <kerninc/Process.hxx>
#include "IDT.hxx"

bool
DeviceNotAvailException(fixregs_t *sa)
{
  if (sa_IsKernel(sa)) {
    dprintf(true, "Kernel floating point error\n");
    DumpFixRegs(sa);
    halt('f');
  }

#ifndef EROS_HAVE_FPU
  if (Thread::CurContext())
    ((Process*) Thread::CurContext())->SetFault(FC_NoFPU, sa->EIP, false);

#else

  if (Process::fpuOwner == Thread::CurContext()) {
    /* If the current process owns the FPU, then this fault should be
     * taken seriously:
     */

#if 0
    uint16_t msw;
    __asm__ __volatile__("smsw %0\n\t" : "=r" (msw));


    dprintf(false, "Active context 0x%08x fp fault pc=0x%08x"
		    " msw=0x%04x\n",
		    Thread::CurContext(), sa->EIP, msw);
    Thread::CurContext()->SaveFPU();
    Thread::CurContext()->DumpFloatRegs();
    
    dprintf(true, "Pausing...\n");
#endif
    
    if (Thread::CurContext())
      ((Process*) Thread::CurContext())->SetFault(FC_FloatingPointError,
						  sa->EIP, false);
  }
  else {
#if 0
    dprintf(false, "Forcing numerics load for ctxt 0x%08x...\n",
		    Thread::CurContext());
#endif
    Thread::CurContext()->ForceNumericsLoad();
  }

#endif

  return false;
}