fpectlmodule.cpp

/*
  ---------------------------------------------------------------------
  /                       Copyright (c) 1996.                           \
  |          The Regents of the University of California.                 |
  |                        All rights reserved.                           |
  |                                                                       |
  |   Permission to use, copy, modify, and distribute this software for   |
  |   any purpose without fee is hereby granted, provided that this en-   |
  |   tire notice is included in all copies of any software which is or   |
  |   includes  a  copy  or  modification  of  this software and in all   |
  |   copies of the supporting documentation for such software.           |
  |                                                                       |
  |   This  work was produced at the University of California, Lawrence   |
  |   Livermore National Laboratory under  contract  no.  W-7405-ENG-48   |
  |   between  the  U.S.  Department  of  Energy and The Regents of the   |
  |   University of California for the operation of UC LLNL.              |
  |                                                                       |
  |                              DISCLAIMER                               |
  |                                                                       |
  |   This  software was prepared as an account of work sponsored by an   |
  |   agency of the United States Government. Neither the United States   |
  |   Government  nor the University of California nor any of their em-   |
  |   ployees, makes any warranty, express or implied, or  assumes  any   |
  |   liability  or  responsibility  for the accuracy, completeness, or   |
  |   usefulness of any information,  apparatus,  product,  or  process   |
  |   disclosed,   or  represents  that  its  use  would  not  infringe   |
  |   privately-owned rights. Reference herein to any specific  commer-   |
  |   cial  products,  process,  or  service  by trade name, trademark,   |
  |   manufacturer, or otherwise, does not  necessarily  constitute  or   |
  |   imply  its endorsement, recommendation, or favoring by the United   |
  |   States Government or the University of California. The views  and   |
  |   opinions  of authors expressed herein do not necessarily state or   |
  |   reflect those of the United States Government or  the  University   |
  |   of  California,  and shall not be used for advertising or product   |
  \  endorsement purposes.                                              /
  ---------------------------------------------------------------------
*/

/*
  Floating point exception control module.

  This Python module provides bare-bones control over floating point
  units from several hardware manufacturers. Specifically, it allows
  the user to turn on the generation of SIGFPE whenever any of the
  three serious IEEE 754 exceptions (Division by Zero, Overflow,
  Invalid Operation) occurs. We currently ignore Underflow and
  Inexact Result exceptions, although those could certainly be added
  if desired.

  The module also establishes a signal handler for SIGFPE during
  initialization. This is an adaptation of the fpectl module
  (https://docs.python.org/2/library/fpectl.html) which code can be
  found in the Python distribution at Module/fpectlmodule.c

  The module has been adapted to modern OS APIs and simplified by the
  use of the C++ exception mechanism. The Python API remains the
  same.

  This module is only useful to you if it happens to include code
  specific for your hardware and software environment. If you can
  contribute OS-specific code for new platforms, or corrections for
  the code provided, it will be greatly appreciated.

  ** Version 1.0: September 20, 1996.  Lee Busby, LLNL.
  ** JSBSim adaptation: June 18, 2016. Bertrand Coconnier
  */

#include "fpectlmodule.h"

#include <signal.h>

#if defined(_MSC_VER)
#  include <float.h>
static unsigned int fp_flags = 0;
#elif defined(__GNUC__) && !defined(sgi)
#  include <fenv.h>
static int fp_flags = 0;
#endif

static PyOS_sighandler_t handler = 0;

static PyObject *fpe_error;
PyMODINIT_FUNC initfpectl(void);
static PyObject *turnon_sigfpe(PyObject *self,PyObject *args);
static PyObject *turnoff_sigfpe(PyObject *self,PyObject *args);

static PyMethodDef fpectl_methods[] = {
  {"turnon_sigfpe", (PyCFunction) turnon_sigfpe, METH_VARARGS},
  {"turnoff_sigfpe", (PyCFunction) turnoff_sigfpe, METH_VARARGS},
  {0,0}
};

static void sigfpe_handler(int signo)
{
  PyOS_setsig(SIGFPE, sigfpe_handler);
  throw JSBSim::FloatingPointException(fpe_error,
                                       "Caught signal SIGFPE in JSBSim");
}

static PyObject *turnon_sigfpe(PyObject *self, PyObject *args)
{
#if defined(_MSC_VER)
  _clearfp();
  fp_flags = _controlfp(_controlfp(0, 0) & ~(_EM_INVALID | _EM_ZERODIVIDE | _EM_OVERFLOW),
                        _MCW_EM);
#elif defined(__GNUC__) && !defined(sgi)
  fp_flags = feenableexcept(FE_DIVBYZERO | FE_INVALID | FE_OVERFLOW);
#endif

  handler = PyOS_setsig(SIGFPE, sigfpe_handler);
  Py_INCREF (Py_None);
  return Py_None;
}

static PyObject *turnoff_sigfpe(PyObject *self, PyObject *args)
{
#if defined(_MSC_VER)
  _controlfp(fp_flags, _MCW_EM);
#elif defined(__GNUC__) && !defined(sgi)
  fedisableexcept(fp_flags);
#endif

  PyOS_setsig(SIGFPE, handler);
  Py_INCREF (Py_None);
  return Py_None;
}

PyMODINIT_FUNC initfpectl(void)
{
  PyObject *m = Py_InitModule("fpectl", fpectl_methods);
  if (m == NULL)
    return;
  PyObject *d = PyModule_GetDict(m);
  fpe_error = PyErr_NewException((char*)"fpectl.FloatingPointError",
                                 PyExc_FloatingPointError, NULL);
  if (fpe_error != NULL)
    PyDict_SetItemString(d, "FloatingPointError", fpe_error);
}