[thirdparty/gcc.git] / libgcc / config / nios2 / lib2-divmod-hi.c

/* Copyright (C) 2012-2019 Free Software Foundation, Inc.
   Contributed by Altera and Mentor Graphics, Inc.

This file 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, or (at your option) any
later version.

This file 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.

Under Section 7 of GPL version 3, you are granted additional
permissions described in the GCC Runtime Library Exception, version
3.1, as published by the Free Software Foundation.

You should have received a copy of the GNU General Public License and
a copy of the GCC Runtime Library Exception along with this program;
see the files COPYING3 and COPYING.RUNTIME respectively.  If not, see
<http://www.gnu.org/licenses/>.  */

#include "lib2-nios2.h"

/* 16-bit HI divide and modulo as used in Nios II.  */

static UHItype
udivmodhi4 (UHItype num, UHItype den, word_type modwanted)
{
  UHItype bit = 1;
  UHItype res = 0;

  while (den < num && bit && !(den & (1L<<15)))
    {
      den <<=1;
      bit <<=1;
    }
  while (bit)
    {
      if (num >= den)
	{
	  num -= den;
	  res |= bit;
	}
      bit >>=1;
      den >>=1;
    }
  if (modwanted)
    return num;
  return res;
}


HItype
__divhi3 (HItype a, HItype b)
{
  word_type neg = 0;
  HItype res;

  if (a < 0)
    {
      a = -a;
      neg = !neg;
    }

  if (b < 0)
    {
      b = -b;
      neg = !neg;
    }

  res = udivmodhi4 (a, b, 0);

  if (neg)
    res = -res;

  return res;
}


HItype
__modhi3 (HItype a, HItype b)
{
  word_type neg = 0;
  HItype res;

  if (a < 0)
    {
      a = -a;
      neg = 1;
    }

  if (b < 0)
    b = -b;

  res = udivmodhi4 (a, b, 1);

  if (neg)
    res = -res;

  return res;
}


UHItype
__udivhi3 (UHItype a, UHItype b)
{
  return udivmodhi4 (a, b, 0);
}


UHItype
__umodhi3 (UHItype a, UHItype b)
{
  return udivmodhi4 (a, b, 1);
}
Commit	Line	Data
fbd26352	1	/* Copyright (C) 2012-2019 Free Software Foundation, Inc.
de65406d	2	Contributed by Altera and Mentor Graphics, Inc.
	3
	4	This file is free software; you can redistribute it and/or modify it
	5	under the terms of the GNU General Public License as published by the
	6	Free Software Foundation; either version 3, or (at your option) any
	7	later version.
	8
	9	This file is distributed in the hope that it will be useful, but
	10	WITHOUT ANY WARRANTY; without even the implied warranty of
	11	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	12	General Public License for more details.
	13
	14	Under Section 7 of GPL version 3, you are granted additional
	15	permissions described in the GCC Runtime Library Exception, version
	16	3.1, as published by the Free Software Foundation.
	17
	18	You should have received a copy of the GNU General Public License and
	19	a copy of the GCC Runtime Library Exception along with this program;
	20	see the files COPYING3 and COPYING.RUNTIME respectively. If not, see
	21	<http://www.gnu.org/licenses/>. */
	22
	23	#include "lib2-nios2.h"
	24
	25	/* 16-bit HI divide and modulo as used in Nios II. */
	26
	27	static UHItype
	28	udivmodhi4 (UHItype num, UHItype den, word_type modwanted)
	29	{
	30	UHItype bit = 1;
	31	UHItype res = 0;
	32
	33	while (den < num && bit && !(den & (1L<<15)))
	34	{
	35	den <<=1;
	36	bit <<=1;
	37	}
	38	while (bit)
	39	{
	40	if (num >= den)
	41	{
	42	num -= den;
	43	res \|= bit;
	44	}
	45	bit >>=1;
	46	den >>=1;
	47	}
	48	if (modwanted)
	49	return num;
	50	return res;
	51	}
	52
	53
	54	HItype
	55	__divhi3 (HItype a, HItype b)
	56	{
	57	word_type neg = 0;
	58	HItype res;
	59
	60	if (a < 0)
	61	{
	62	a = -a;
	63	neg = !neg;
	64	}
	65
66	if (b < 0)
67	{
68	b = -b;
69	neg = !neg;
70	}
71
72	res = udivmodhi4 (a, b, 0);
73
74	if (neg)
75	res = -res;
76
77	return res;
78	}
79
80
81	HItype
82	__modhi3 (HItype a, HItype b)
83	{
84	word_type neg = 0;
85	HItype res;
86
87	if (a < 0)
88	{
89	a = -a;
90	neg = 1;
91	}
92
93	if (b < 0)
94	b = -b;
95
96	res = udivmodhi4 (a, b, 1);
97
98	if (neg)
99	res = -res;
100
101	return res;
102	}
103
104
105	UHItype
106	__udivhi3 (UHItype a, UHItype b)
107	{
108	return udivmodhi4 (a, b, 0);
109	}
110
111
112	UHItype
113	__umodhi3 (UHItype a, UHItype b)
114	{
115	return udivmodhi4 (a, b, 1);
116	}
117