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
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
|
/******************************************************************************
* Copyright (c) 2004, 2008 IBM Corporation
* All rights reserved.
* This program and the accompanying materials
* are made available under the terms of the BSD License
* which accompanies this distribution, and is available at
* http://www.opensource.org/licenses/bsd-license.php
*
* Contributors:
* IBM Corporation - initial implementation
*****************************************************************************/
#include <cpu.h>
#include <stdint.h>
#include <hw.h>
uint16_t
bswap16_load(uint64_t addr)
{
unsigned int val;
set_ci();
asm volatile ("lhbrx %0, 0, %1":"=r" (val):"r"(addr));
clr_ci();
return val;
}
uint32_t
bswap32_load(uint64_t addr)
{
unsigned int val;
set_ci();
asm volatile ("lwbrx %0, 0, %1":"=r" (val):"r"(addr));
clr_ci();
return val;
}
void
bswap16_store(uint64_t addr, uint16_t val)
{
set_ci();
asm volatile ("sthbrx %0, 0, %1"::"r" (val), "r"(addr));
clr_ci();
}
void
bswap32_store(uint64_t addr, uint32_t val)
{
set_ci();
asm volatile ("stwbrx %0, 0, %1"::"r" (val), "r"(addr));
clr_ci();
}
uint8_t
load8_ci(uint64_t addr)
{
uint8_t val;
set_ci();
val = *(uint8_t *) addr;
clr_ci();
return val;
}
uint16_t
load16_ci(uint64_t addr)
{
uint16_t val;
set_ci();
val = *(uint16_t *) addr;
clr_ci();
return val;
}
uint32_t
load32_ci(uint64_t addr)
{
uint32_t val;
set_ci();
val = *(uint32_t *) addr;
clr_ci();
return val;
}
uint64_t
load64_ci(uint64_t addr)
{
uint64_t val;
set_ci();
val = *(uint64_t *) addr;
clr_ci();
return val;
}
void
store8_ci(uint64_t addr, uint8_t val)
{
set_ci();
*(uint8_t *) addr = val;
clr_ci();
}
void
store16_ci(uint64_t addr, uint16_t val)
{
set_ci();
*(uint16_t *) addr = val;
clr_ci();
}
void
store32_ci(uint64_t addr, uint32_t val)
{
set_ci();
*(uint32_t *) addr = val;
clr_ci();
}
void
store64_ci(uint64_t addr, uint64_t val)
{
set_ci();
*(uint64_t *) addr = val;
clr_ci();
}
|
