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
125
126
127
128
129
130
|
/* Copyright 2013-2014 IBM Corp.
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or
* implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include <skiboot.h>
#include <lock.h>
#include <assert.h>
#include <processor.h>
#include <cpu.h>
#include <console.h>
/* Set to bust locks. Note, this is initialized to true because our
* lock debugging code is not going to work until we have the per
* CPU data initialized
*/
bool bust_locks = true;
#ifdef DEBUG_LOCKS
static void lock_error(struct lock *l, const char *reason, uint16_t err)
{
op_display(OP_FATAL, OP_MOD_LOCK, err);
fprintf(stderr, "LOCK ERROR: %s @%p (state: 0x%016lx)\n",
reason, l, l->lock_val);
abort();
}
static void lock_check(struct lock *l)
{
if ((l->lock_val & 1) && (l->lock_val >> 32) == this_cpu()->pir)
lock_error(l, "Invalid recursive lock", 0);
}
static void unlock_check(struct lock *l)
{
if (!(l->lock_val & 1))
lock_error(l, "Unlocking unlocked lock", 1);
if ((l->lock_val >> 32) != this_cpu()->pir)
lock_error(l, "Unlocked non-owned lock", 2);
if (l->in_con_path && this_cpu()->con_suspend == 0)
lock_error(l, "Unlock con lock with console not suspended", 3);
}
#else
static inline void lock_check(struct lock *l) { };
static inline void unlock_check(struct lock *l) { };
#endif /* DEBUG_LOCKS */
bool lock_held_by_me(struct lock *l)
{
uint64_t pir64 = this_cpu()->pir;
return l->lock_val == ((pir64 << 32) | 1);
}
bool try_lock(struct lock *l)
{
if (__try_lock(l)) {
if (l->in_con_path)
this_cpu()->con_suspend++;
return true;
}
return false;
}
void lock(struct lock *l)
{
if (bust_locks)
return;
lock_check(l);
for (;;) {
if (try_lock(l))
break;
cpu_relax();
}
}
void unlock(struct lock *l)
{
struct cpu_thread *cpu = this_cpu();
if (bust_locks)
return;
unlock_check(l);
lwsync();
l->lock_val = 0;
if (l->in_con_path) {
cpu->con_suspend--;
if (cpu->con_suspend == 0 && cpu->con_need_flush)
flush_console();
}
}
bool lock_recursive(struct lock *l)
{
if (bust_locks)
return false;
if ((l->lock_val & 1) &&
(l->lock_val >> 32) == this_cpu()->pir)
return false;
lock(l);
return true;
}
void init_locks(void)
{
bust_locks = false;
}
|