mes/src/math.c

/* -*-comment-start: "//";comment-end:""-*-
 * GNU Mes --- Maxwell Equations of Software
 * Copyright © 2016,2017,2018,2019 Jan (janneke) Nieuwenhuizen <janneke@gnu.org>
 * Copyright © 2021 W. J. van der Laan <laanwj@protonmail.com>
 *
 * This file is part of GNU Mes.
 *
 * GNU Mes 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 3 of the License, or (at
 * your option) any later version.
 *
 * GNU Mes 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 GNU Mes.  If not, see <http://www.gnu.org/licenses/>.
 */

#include "mes/lib.h"
#include "mes/mes.h"

#include <ctype.h>
#include <limits.h>
#include <stdio.h>
#include <string.h>

void
assert_number (char const *name, SCM x)
{
  if (TYPE (x) != TNUMBER)
    {
      eputs (name);
      error (cell_symbol_not_a_number, x);
    }
}

SCM
greater_p (SCM x)               /*:((name . ">") (arity . n)) */
{
  if (x == cell_nil)
    return cell_t;
  assert_number ("greater_p", CAR (x));
  long n = VALUE (CAR (x));
  x = CDR (x);
  while (x != cell_nil)
    {
      assert_number ("greater_p", CAR (x));
      SCM i = car (x);
      long v = VALUE (i);
      if (v >= n)
        return cell_f;
      n = v;
      x = cdr (x);
    }
  return cell_t;
}

SCM
less_p (SCM x)                  /*:((name . "<") (arity . n)) */
{
  if (x == cell_nil)
    return cell_t;
  assert_number ("less_p", CAR (x));
  long n = VALUE (CAR (x));
  x = CDR (x);
  while (x != cell_nil)
    {
      assert_number ("less_p", CAR (x));
      SCM i = car (x);
      long v = VALUE (i);
      if (v <= n)
        return cell_f;
      n = v;
      x = cdr (x);
    }
  return cell_t;
}

SCM
is_p (SCM x)                    /*:((name . "=") (arity . n)) */
{
  if (x == cell_nil)
    return cell_t;
  assert_number ("is_p", CAR (x));
  long n = VALUE (CAR (x));
  x = cdr (x);
  while (x != cell_nil)
    {
      SCM i = car (x);
      long v = VALUE (i);
      if (v != n)
        return cell_f;
      x = cdr (x);
    }
  return cell_t;
}

SCM
minus (SCM x)                   /*:((name . "-") (arity . n)) */
{
  assert_number ("minus", CAR (x));
  long n = VALUE (CAR (x));
  x = cdr (x);
  if (x == cell_nil)
    n = -n;
  while (x != cell_nil)
    {
      SCM i = car (x);
      assert_number ("minus", i);
      long v = VALUE (i);
      n = n - v;
      x = cdr (x);
    }
  return make_number (n);
}

SCM
plus (SCM x)                    /*:((name . "+") (arity . n)) */
{
  long n = 0;
  while (x != cell_nil)
    {
      SCM i = car (x);
      assert_number ("plus", i);
      long v = VALUE (i);
      n = n + v;
      x = cdr (x);
    }
  return make_number (n);
}

SCM
divide (SCM x)                  /*:((name . "/") (arity . n)) */
{
  long n = 1;
  if (x != cell_nil)
    {
      SCM i = car (x);
      assert_number ("divide", i);
      long v = VALUE (i);
      n = v;
      x = cdr (x);
    }
  while (x != cell_nil)
    {
      SCM i = car (x);
      assert_number ("divide", i);
      long v = VALUE (i);
      if (v == 0)
        error (cstring_to_symbol ("divide-by-zero"), x);
      if (n == 0)
        break;
      n = n / v;
      x = cdr (x);
    }
  return make_number (n);
}

SCM
modulo (SCM a, SCM b)
{
  assert_number ("modulo", a);
  assert_number ("modulo", b);
  long x = VALUE (a);
  long y = VALUE (b);
  if (y == 0)
    error (cstring_to_symbol ("divide-by-zero"), a);
  while (x < 0)
    x = x + y;
  if (x != 0)
    x = x % y;

  return make_number (x);
}

SCM
multiply (SCM x)                /*:((name . "*") (arity . n)) */
{
  long n = 1;
  while (x != cell_nil)
    {
      SCM i = car (x);
      assert_number ("multiply", i);
      long v = VALUE (i);
      n = n * v;
      x = cdr (x);
    }
  return make_number (n);
}

SCM
logand (SCM x)                  /*:((arity . n)) */
{
  long n = -1;
  while (x != cell_nil)
    {
      SCM i = car (x);
      assert_number ("multiply", i);
      long v = VALUE (i);
      n = n & v;
      x = cdr (x);
    }
  return make_number (n);
}

SCM
logior (SCM x)                  /*:((arity . n)) */
{
  long n = 0;
  while (x != cell_nil)
    {
      SCM i = car (x);
      assert_number ("logior", i);
      long v = VALUE (i);
      n = n | v;
      x = cdr (x);
    }
  return make_number (n);
}

SCM
lognot (SCM x)
{
  assert_number ("lognot", x);
  long n = ~VALUE (x);
  return make_number (n);
}

SCM
logxor (SCM x)                  /*:((arity . n)) */
{
  long n = 0;
  while (x != cell_nil)
    {
      SCM i = car (x);
      assert_number ("logxor", i);
      long v = VALUE (i);
      n = n ^ v;
      x = cdr (x);
    }
  return make_number (n);
}

SCM
ash (SCM n, SCM count)
{
  assert_number ("ash", n);
  assert_number ("ash", count);
  long cn = VALUE (n);
  long ccount = VALUE (count);
  long result;
  if (ccount < 0)
    result = cn >> -ccount;
  else
    result = cn << ccount;
  return make_number (result);
}