-
Notifications
You must be signed in to change notification settings - Fork 19
/
functions_saturation.go
68 lines (57 loc) · 1.92 KB
/
functions_saturation.go
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
// This file is part of Gopher2600.
//
// Gopher2600 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.
//
// Gopher2600 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 Gopher2600. If not, see <https://www.gnu.org/licenses/>.
package fpu
import (
"math"
)
// page A-29 of "ARMv7-M"
//
// "Some instructions perform saturating arithmetic, that is, if the result of
// the arithmetic overflows the destination signed or unsigned N-bit integer
// range, the result produced is the largest or smallest value in that range,
// rather than wrapping around modulo 2 N . This is supported in pseudocode by
// the SignedSatQ() and UnsignedSatQ() functions when a boolean result is wanted
// saying whether saturation occurred, and by the SignedSat() and UnsignedSat()
// functions when only the saturated result is wanted"
func (fpu *FPU) SignedSatQ(i int, N int) (uint64, bool) {
var result uint64
var saturated bool
powNm1 := int(math.Pow(2, float64(N-1)))
if i > powNm1-1 {
result = uint64(powNm1 - 1)
saturated = true
} else if i < -powNm1 {
result = uint64(-powNm1)
saturated = true
} else {
result = uint64(i)
}
return result & ((1 << N) - 1), saturated
}
func (fpu *FPU) UnsignedSatQ(i int, N int) (uint64, bool) {
var result uint64
var saturated bool
powN := int(math.Pow(2, float64(N)))
if i > powN-1 {
result = uint64(powN - 1)
saturated = true
} else if i < 0 {
result = 0
saturated = true
} else {
result = uint64(i)
}
return result & ((1 << N) - 1), saturated
}