git.gag.com Git - debian/cc1111/blob - device/lib/pic/libsdcc/_moduchar.c

   1 /* ---------------------------------------------------------------------------
   2    _moduchar.c : 8 bit modulus routines for pic14 devices
   3
   4         Written By      Raphael Neider <rneider AT web.de> (2005)
   5
   6    This library is free software; you can redistribute it and/or
   7    modify it under the terms of the GNU Library General Public
   8    License as published by the Free Software Foundation; either
   9    version 2 of the License, or (at your option) any later version.
  10
  11    This library is distributed in the hope that it will be useful,
  12    but WITHOUT ANY WARRANTY; without even the implied warranty of
  13    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  14    Library General Public License for more details.
  15
  16    You should have received a copy of the GNU Library General Public
  17    License along with this library; if not, write to the
  18    Free Software Foundation, Inc., 59 Temple Place - Suite 330,
  19    Boston, MA  02111-1307  USA.
  20
  21    In other words, you are welcome to use, share and improve this program.
  22    You are forbidden to forbid anyone else to use, share and improve
  23    what you give them.   Help stamp out software-hoarding!
  24
  25    $Id: _moduchar.c 4148 2006-05-01 20:47:12Z tecodev $
  26    ------------------------------------------------------------------------ */
  27
  28 unsigned char
  29 _moduchar (unsigned char a, unsigned char b)
  30 {
  31   unsigned char count = 1;
  32
  33   /* prevent endless loop (division by zero exception?!?) */
  34   if (!b) return (unsigned char)-1;
  35
  36   /* it would suffice to make b >= a, but that test is
  37    * more complex and will fail if a has its MSB set */
  38   while (!(b & (1UL << (8*sizeof(unsigned char)-1)))) {
  39     b <<= 1;
  40     ++count;
  41   } // while
  42
  43   /* now subtract all the powers of two (of b) that "fit" into a */
  44   while (count) {
  45     if (a >= b) {
  46       a -= b;
  47     } // if
  48     b >>= 1;
  49     --count;
  50   } // while
  51
  52   return a;
  53 }
  54