libgcc/config/lm32/_modsi3.c

   1 /* _modsi3 for Lattice Mico32.
   2    Contributed by Jon Beniston <jon@beniston.com>
   3
   4    Copyright (C) 2009-2016 Free Software Foundation, Inc.
   5
   6    This file is free software; you can redistribute it and/or modify it
   7    under the terms of the GNU General Public License as published by the
   8    Free Software Foundation; either version 3, or (at your option) any
   9    later version.
  10
  11    This file is distributed in the hope that it will be useful, but
  12    WITHOUT ANY WARRANTY; without even the implied warranty of
  13    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14    General Public License for more details.
  15
  16    Under Section 7 of GPL version 3, you are granted additional
  17    permissions described in the GCC Runtime Library Exception, version
  18    3.1, as published by the Free Software Foundation.
  19
  20    You should have received a copy of the GNU General Public License and
  21    a copy of the GCC Runtime Library Exception along with this program;
  22    see the files COPYING3 and COPYING.RUNTIME respectively.  If not, see
  23    <http://www.gnu.org/licenses/>. */
  24
  25 #include "libgcc_lm32.h"
  26
  27 /* Signed integer modulus.  */
  28
  29 SItype
  30 __modsi3 (SItype a, SItype b)
  31 {
  32   int neg = 0;
  33   SItype res;
  34   int cfg;
  35
  36   if (b == 0)
  37     {
  38       /* Raise divide by zero exception.  */
  39       int eba, sr;
  40       /* Save interrupt enable.  */
  41       __asm__ __volatile__ ("rcsr %0, IE":"=r" (sr));
  42       sr = (sr & 1) << 1;
  43       __asm__ __volatile__ ("wcsr IE, %0"::"r" (sr));
  44       /* Branch to exception handler.  */
  45       __asm__ __volatile__ ("rcsr %0, EBA":"=r" (eba));
  46       eba += 32 * 5;
  47       __asm__ __volatile__ ("mv ea, ra");
  48       __asm__ __volatile__ ("b %0"::"r" (eba));
  49       __builtin_unreachable ();
  50     }
  51
  52   if (a < 0)
  53     {
  54       a = -a;
  55       neg = 1;
  56     }
  57
  58   if (b < 0)
  59     b = -b;
  60
  61 __asm__ ("rcsr %0, CFG":"=r" (cfg));
  62   if (cfg & 2)
  63   __asm__ ("modu %0, %1, %2": "=r" (res):"r" (a), "r" (b));
  64   else
  65     res = __udivmodsi4 (a, b, 1);
  66
  67   if (neg)
  68     res = -res;
  69
  70   return res;
  71 }