Subversion Repositories HelenOS

Rev

Rev 2071 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
810 cejka 1
/*
2071 jermar 2
 * Copyright (c) 2006 Josef Cejka
810 cejka 3
 * All rights reserved.
4
 *
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
7
 * are met:
8
 *
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
14
 * - The name of the author may not be used to endorse or promote products
15
 *   derived from this software without specific prior written permission.
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
28
 
1888 jermar 29
/** @addtogroup genarch
1702 cejka 30
 * @{
31
 */
32
/** @file
33
 */
34
 
811 jermar 35
#include <genarch/softint/division.h>
810 cejka 36
 
37
#define ABSVAL(x) ( (x) > 0 ? (x) : -(x))
38
#define SGN(x) ( (x) >= 0 ? 1 : 0 )
39
 
40
static unsigned int divandmod32(unsigned int a, unsigned int b, unsigned int *remainder)
41
{
42
    unsigned int result;
811 jermar 43
    int steps = sizeof(unsigned int) * 8;
810 cejka 44
 
45
    *remainder = 0;
46
    result = 0;
47
 
48
    if (b == 0) {
49
        /* FIXME: division by zero */
50
        return 0;
51
    }
52
 
53
    if ( a < b) {
54
        *remainder = a;
55
        return 0;
56
    }
57
 
58
    for ( ; steps > 0; steps--) {
59
        /* shift one bit to remainder */
811 jermar 60
        *remainder = ( (*remainder) << 1) | (( a >> 31) & 0x1);
810 cejka 61
        result <<= 1;
62
 
63
        if (*remainder >= b) {
64
                *remainder -= b;
65
                result |= 0x1;
66
        }
811 jermar 67
        a <<= 1;
810 cejka 68
    }
69
 
70
    return result;
71
}
72
 
73
 
1196 cejka 74
static unsigned long long divandmod64(unsigned long long a, unsigned long long b, unsigned long long *remainder)
810 cejka 75
{
1196 cejka 76
    unsigned long long result;
77
    int steps = sizeof(unsigned long long) * 8;
810 cejka 78
 
79
    *remainder = 0;
80
    result = 0;
81
 
82
    if (b == 0) {
83
        /* FIXME: division by zero */
84
        return 0;
85
    }
86
 
87
    if ( a < b) {
88
        *remainder = a;
89
        return 0;
90
    }
91
 
92
    for ( ; steps > 0; steps--) {
93
        /* shift one bit to remainder */
811 jermar 94
        *remainder = ( (*remainder) << 1) | ((a >> 63) & 0x1);
810 cejka 95
        result <<= 1;
96
 
97
        if (*remainder >= b) {
98
                *remainder -= b;
99
                result |= 0x1;
100
        }
811 jermar 101
        a <<= 1;
810 cejka 102
    }
103
 
104
    return result;
105
}
106
 
107
/* 32bit integer division */
108
int __divsi3(int a, int b)
109
{
110
    unsigned int rem;
111
    int result;
112
 
113
    result = (int)divandmod32(ABSVAL(a), ABSVAL(b), &rem);
114
 
115
    if ( SGN(a) == SGN(b)) return result;
116
    return -result;
117
}
118
 
119
/* 64bit integer division */
1196 cejka 120
long long __divdi3(long long a, long long b)
810 cejka 121
{
1196 cejka 122
    unsigned long long rem;
123
    long long result;
810 cejka 124
 
1196 cejka 125
    result = (long long)divandmod64(ABSVAL(a), ABSVAL(b), &rem);
810 cejka 126
 
127
    if ( SGN(a) == SGN(b)) return result;
128
    return -result;
129
}
130
 
131
/* 32bit unsigned integer division */
132
unsigned int __udivsi3(unsigned int a, unsigned int b)
133
{
134
    unsigned int rem;
135
    return divandmod32(a, b, &rem);
136
}
137
 
138
/* 64bit unsigned integer division */
1196 cejka 139
unsigned long long __udivdi3(unsigned long long a, unsigned long long b)
810 cejka 140
{
1196 cejka 141
    unsigned long long  rem;
810 cejka 142
    return divandmod64(a, b, &rem);
143
}
144
 
145
/* 32bit remainder of the signed division */
146
int __modsi3(int a, int b)
147
{
148
    unsigned int rem;
149
    divandmod32(a, b, &rem);
150
 
811 jermar 151
    /* if divident is negative, remainder must be too */
810 cejka 152
    if (!(SGN(a))) {
153
        return -((int)rem);
154
    }
155
 
156
    return (int)rem;
157
}
158
 
159
/* 64bit remainder of the signed division */
1196 cejka 160
long long __moddi3(long long a,long  long b)
810 cejka 161
{
1196 cejka 162
    unsigned long long rem;
810 cejka 163
    divandmod64(a, b, &rem);
164
 
811 jermar 165
    /* if divident is negative, remainder must be too */
810 cejka 166
    if (!(SGN(a))) {
1196 cejka 167
        return -((long long)rem);
810 cejka 168
    }
169
 
1196 cejka 170
    return (long long)rem;
810 cejka 171
}
172
 
173
/* 32bit remainder of the unsigned division */
174
unsigned int __umodsi3(unsigned int a, unsigned int b)
175
{
176
    unsigned int rem;
177
    divandmod32(a, b, &rem);
178
    return rem;
179
}
180
 
181
/* 64bit remainder of the unsigned division */
1196 cejka 182
unsigned long long __umoddi3(unsigned long long a, unsigned long long b)
810 cejka 183
{
1196 cejka 184
    unsigned long long rem;
810 cejka 185
    divandmod64(a, b, &rem);
186
    return rem;
187
}
188
 
1196 cejka 189
unsigned long long __udivmoddi3(unsigned long long a, unsigned long long b, unsigned long long *c)
810 cejka 190
{
191
    return divandmod64(a, b, c);
192
}
193
 
1888 jermar 194
/** @}
1702 cejka 195
 */