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
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
|
/*
* ARMv6 integer SIMD operations.
*
* Copyright (c) 2007 CodeSourcery.
* Written by Paul Brook
*
* This code is licenced under the GPL.
*/
#ifdef ARITH_GE
#define GE_ARG , uint32_t *gep
#define DECLARE_GE uint32_t ge = 0
#define SET_GE *gep = ge
#else
#define GE_ARG
#define DECLARE_GE do{}while(0)
#define SET_GE do{}while(0)
#endif
#define RESULT(val, n, width) \
res |= ((uint32_t)(glue(glue(uint,width),_t))(val)) << (n * width)
uint32_t HELPER(glue(PFX,add16))(uint32_t a, uint32_t b GE_ARG)
{
uint32_t res = 0;
DECLARE_GE;
ADD16(a, b, 0);
ADD16(a >> 16, b >> 16, 1);
SET_GE;
return res;
}
uint32_t HELPER(glue(PFX,add8))(uint32_t a, uint32_t b GE_ARG)
{
uint32_t res = 0;
DECLARE_GE;
ADD8(a, b, 0);
ADD8(a >> 8, b >> 8, 1);
ADD8(a >> 16, b >> 16, 2);
ADD8(a >> 24, b >> 24, 3);
SET_GE;
return res;
}
uint32_t HELPER(glue(PFX,sub16))(uint32_t a, uint32_t b GE_ARG)
{
uint32_t res = 0;
DECLARE_GE;
SUB16(a, b, 0);
SUB16(a >> 16, b >> 16, 1);
SET_GE;
return res;
}
uint32_t HELPER(glue(PFX,sub8))(uint32_t a, uint32_t b GE_ARG)
{
uint32_t res = 0;
DECLARE_GE;
SUB8(a, b, 0);
SUB8(a >> 8, b >> 8, 1);
SUB8(a >> 16, b >> 16, 2);
SUB8(a >> 24, b >> 24, 3);
SET_GE;
return res;
}
uint32_t HELPER(glue(PFX,subaddx))(uint32_t a, uint32_t b GE_ARG)
{
uint32_t res = 0;
DECLARE_GE;
ADD16(a, b, 0);
SUB16(a >> 16, b >> 16, 1);
SET_GE;
return res;
}
uint32_t HELPER(glue(PFX,addsubx))(uint32_t a, uint32_t b GE_ARG)
{
uint32_t res = 0;
DECLARE_GE;
SUB16(a, b, 0);
ADD16(a >> 16, b >> 16, 1);
SET_GE;
return res;
}
#undef GE_ARG
#undef DECLARE_GE
#undef SET_GE
#undef RESULT
#undef ARITH_GE
#undef PFX
#undef ADD16
#undef SUB16
#undef ADD8
#undef SUB8
|