1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* |
3 | * PS3 repository routines. |
4 | * |
5 | * Copyright (C) 2006 Sony Computer Entertainment Inc. |
6 | * Copyright 2006 Sony Corp. |
7 | */ |
8 | |
9 | #include <asm/lv1call.h> |
10 | |
11 | #include "platform.h" |
12 | |
13 | enum ps3_vendor_id { |
14 | PS3_VENDOR_ID_NONE = 0, |
15 | PS3_VENDOR_ID_SONY = 0x8000000000000000UL, |
16 | }; |
17 | |
18 | enum ps3_lpar_id { |
19 | PS3_LPAR_ID_CURRENT = 0, |
20 | PS3_LPAR_ID_PME = 1, |
21 | }; |
22 | |
23 | #define dump_field(_a, _b) _dump_field(_a, _b, __func__, __LINE__) |
24 | static void _dump_field(const char *hdr, u64 n, const char *func, int line) |
25 | { |
26 | #if defined(DEBUG) |
27 | char s[16]; |
28 | const char *const in = (const char *)&n; |
29 | unsigned int i; |
30 | |
31 | for (i = 0; i < 8; i++) |
32 | s[i] = (in[i] <= 126 && in[i] >= 32) ? in[i] : '.'; |
33 | s[i] = 0; |
34 | |
35 | pr_devel("%s:%d: %s%016llx : %s\n" , func, line, hdr, n, s); |
36 | #endif |
37 | } |
38 | |
39 | #define dump_node_name(_a, _b, _c, _d, _e) \ |
40 | _dump_node_name(_a, _b, _c, _d, _e, __func__, __LINE__) |
41 | static void _dump_node_name(unsigned int lpar_id, u64 n1, u64 n2, u64 n3, |
42 | u64 n4, const char *func, int line) |
43 | { |
44 | pr_devel("%s:%d: lpar: %u\n" , func, line, lpar_id); |
45 | _dump_field(hdr: "n1: " , n: n1, func, line); |
46 | _dump_field(hdr: "n2: " , n: n2, func, line); |
47 | _dump_field(hdr: "n3: " , n: n3, func, line); |
48 | _dump_field(hdr: "n4: " , n: n4, func, line); |
49 | } |
50 | |
51 | #define dump_node(_a, _b, _c, _d, _e, _f, _g) \ |
52 | _dump_node(_a, _b, _c, _d, _e, _f, _g, __func__, __LINE__) |
53 | static void _dump_node(unsigned int lpar_id, u64 n1, u64 n2, u64 n3, u64 n4, |
54 | u64 v1, u64 v2, const char *func, int line) |
55 | { |
56 | pr_devel("%s:%d: lpar: %u\n" , func, line, lpar_id); |
57 | _dump_field(hdr: "n1: " , n: n1, func, line); |
58 | _dump_field(hdr: "n2: " , n: n2, func, line); |
59 | _dump_field(hdr: "n3: " , n: n3, func, line); |
60 | _dump_field(hdr: "n4: " , n: n4, func, line); |
61 | pr_devel("%s:%d: v1: %016llx\n" , func, line, v1); |
62 | pr_devel("%s:%d: v2: %016llx\n" , func, line, v2); |
63 | } |
64 | |
65 | /** |
66 | * make_first_field - Make the first field of a repository node name. |
67 | * @text: Text portion of the field. |
68 | * @index: Numeric index portion of the field. Use zero for 'don't care'. |
69 | * |
70 | * This routine sets the vendor id to zero (non-vendor specific). |
71 | * Returns field value. |
72 | */ |
73 | |
74 | static u64 make_first_field(const char *text, u64 index) |
75 | { |
76 | u64 n = 0; |
77 | |
78 | memcpy((char *)&n, text, strnlen(text, sizeof(n))); |
79 | return PS3_VENDOR_ID_NONE + (n >> 32) + index; |
80 | } |
81 | |
82 | /** |
83 | * make_field - Make subsequent fields of a repository node name. |
84 | * @text: Text portion of the field. Use "" for 'don't care'. |
85 | * @index: Numeric index portion of the field. Use zero for 'don't care'. |
86 | * |
87 | * Returns field value. |
88 | */ |
89 | |
90 | static u64 make_field(const char *text, u64 index) |
91 | { |
92 | u64 n = 0; |
93 | |
94 | memcpy((char *)&n, text, strnlen(text, sizeof(n))); |
95 | return n + index; |
96 | } |
97 | |
98 | /** |
99 | * read_node - Read a repository node from raw fields. |
100 | * @n1: First field of node name. |
101 | * @n2: Second field of node name. Use zero for 'don't care'. |
102 | * @n3: Third field of node name. Use zero for 'don't care'. |
103 | * @n4: Fourth field of node name. Use zero for 'don't care'. |
104 | * @v1: First repository value (high word). |
105 | * @v2: Second repository value (low word). Optional parameter, use zero |
106 | * for 'don't care'. |
107 | */ |
108 | |
109 | static int read_node(unsigned int lpar_id, u64 n1, u64 n2, u64 n3, u64 n4, |
110 | u64 *_v1, u64 *_v2) |
111 | { |
112 | int result; |
113 | u64 v1; |
114 | u64 v2; |
115 | |
116 | if (lpar_id == PS3_LPAR_ID_CURRENT) { |
117 | u64 id; |
118 | lv1_get_logical_partition_id(&id); |
119 | lpar_id = id; |
120 | } |
121 | |
122 | result = lv1_read_repository_node(lpar_id, n1, n2, n3, n4, &v1, |
123 | &v2); |
124 | |
125 | if (result) { |
126 | pr_warn("%s:%d: lv1_read_repository_node failed: %s\n" , |
127 | __func__, __LINE__, ps3_result(result)); |
128 | dump_node_name(lpar_id, n1, n2, n3, n4); |
129 | return -ENOENT; |
130 | } |
131 | |
132 | dump_node(lpar_id, n1, n2, n3, n4, v1, v2); |
133 | |
134 | if (_v1) |
135 | *_v1 = v1; |
136 | if (_v2) |
137 | *_v2 = v2; |
138 | |
139 | if (v1 && !_v1) |
140 | pr_devel("%s:%d: warning: discarding non-zero v1: %016llx\n" , |
141 | __func__, __LINE__, v1); |
142 | if (v2 && !_v2) |
143 | pr_devel("%s:%d: warning: discarding non-zero v2: %016llx\n" , |
144 | __func__, __LINE__, v2); |
145 | |
146 | return 0; |
147 | } |
148 | |
149 | int ps3_repository_read_bus_str(unsigned int bus_index, const char *bus_str, |
150 | u64 *value) |
151 | { |
152 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
153 | n1: make_first_field(text: "bus" , index: bus_index), |
154 | n2: make_field(text: bus_str, index: 0), |
155 | n3: 0, n4: 0, |
156 | v1: value, NULL); |
157 | } |
158 | |
159 | int ps3_repository_read_bus_id(unsigned int bus_index, u64 *bus_id) |
160 | { |
161 | return read_node(lpar_id: PS3_LPAR_ID_PME, n1: make_first_field(text: "bus" , index: bus_index), |
162 | n2: make_field(text: "id" , index: 0), n3: 0, n4: 0, v1: bus_id, NULL); |
163 | } |
164 | |
165 | int ps3_repository_read_bus_type(unsigned int bus_index, |
166 | enum ps3_bus_type *bus_type) |
167 | { |
168 | int result; |
169 | u64 v1 = 0; |
170 | |
171 | result = read_node(lpar_id: PS3_LPAR_ID_PME, |
172 | n1: make_first_field(text: "bus" , index: bus_index), |
173 | n2: make_field(text: "type" , index: 0), |
174 | n3: 0, n4: 0, |
175 | v1: &v1, NULL); |
176 | *bus_type = v1; |
177 | return result; |
178 | } |
179 | |
180 | int ps3_repository_read_bus_num_dev(unsigned int bus_index, |
181 | unsigned int *num_dev) |
182 | { |
183 | int result; |
184 | u64 v1 = 0; |
185 | |
186 | result = read_node(lpar_id: PS3_LPAR_ID_PME, |
187 | n1: make_first_field(text: "bus" , index: bus_index), |
188 | n2: make_field(text: "num_dev" , index: 0), |
189 | n3: 0, n4: 0, |
190 | v1: &v1, NULL); |
191 | *num_dev = v1; |
192 | return result; |
193 | } |
194 | |
195 | int ps3_repository_read_dev_str(unsigned int bus_index, |
196 | unsigned int dev_index, const char *dev_str, u64 *value) |
197 | { |
198 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
199 | n1: make_first_field(text: "bus" , index: bus_index), |
200 | n2: make_field(text: "dev" , index: dev_index), |
201 | n3: make_field(text: dev_str, index: 0), |
202 | n4: 0, |
203 | v1: value, NULL); |
204 | } |
205 | |
206 | int ps3_repository_read_dev_id(unsigned int bus_index, unsigned int dev_index, |
207 | u64 *dev_id) |
208 | { |
209 | return read_node(lpar_id: PS3_LPAR_ID_PME, n1: make_first_field(text: "bus" , index: bus_index), |
210 | n2: make_field(text: "dev" , index: dev_index), n3: make_field(text: "id" , index: 0), n4: 0, |
211 | v1: dev_id, NULL); |
212 | } |
213 | |
214 | int ps3_repository_read_dev_type(unsigned int bus_index, |
215 | unsigned int dev_index, enum ps3_dev_type *dev_type) |
216 | { |
217 | int result; |
218 | u64 v1 = 0; |
219 | |
220 | result = read_node(lpar_id: PS3_LPAR_ID_PME, |
221 | n1: make_first_field(text: "bus" , index: bus_index), |
222 | n2: make_field(text: "dev" , index: dev_index), |
223 | n3: make_field(text: "type" , index: 0), |
224 | n4: 0, |
225 | v1: &v1, NULL); |
226 | *dev_type = v1; |
227 | return result; |
228 | } |
229 | |
230 | int ps3_repository_read_dev_intr(unsigned int bus_index, |
231 | unsigned int dev_index, unsigned int intr_index, |
232 | enum ps3_interrupt_type *intr_type, unsigned int *interrupt_id) |
233 | { |
234 | int result; |
235 | u64 v1 = 0; |
236 | u64 v2 = 0; |
237 | |
238 | result = read_node(lpar_id: PS3_LPAR_ID_PME, |
239 | n1: make_first_field(text: "bus" , index: bus_index), |
240 | n2: make_field(text: "dev" , index: dev_index), |
241 | n3: make_field(text: "intr" , index: intr_index), |
242 | n4: 0, |
243 | v1: &v1, v2: &v2); |
244 | *intr_type = v1; |
245 | *interrupt_id = v2; |
246 | return result; |
247 | } |
248 | |
249 | int ps3_repository_read_dev_reg_type(unsigned int bus_index, |
250 | unsigned int dev_index, unsigned int reg_index, |
251 | enum ps3_reg_type *reg_type) |
252 | { |
253 | int result; |
254 | u64 v1 = 0; |
255 | |
256 | result = read_node(lpar_id: PS3_LPAR_ID_PME, |
257 | n1: make_first_field(text: "bus" , index: bus_index), |
258 | n2: make_field(text: "dev" , index: dev_index), |
259 | n3: make_field(text: "reg" , index: reg_index), |
260 | n4: make_field(text: "type" , index: 0), |
261 | v1: &v1, NULL); |
262 | *reg_type = v1; |
263 | return result; |
264 | } |
265 | |
266 | int ps3_repository_read_dev_reg_addr(unsigned int bus_index, |
267 | unsigned int dev_index, unsigned int reg_index, u64 *bus_addr, u64 *len) |
268 | { |
269 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
270 | n1: make_first_field(text: "bus" , index: bus_index), |
271 | n2: make_field(text: "dev" , index: dev_index), |
272 | n3: make_field(text: "reg" , index: reg_index), |
273 | n4: make_field(text: "data" , index: 0), |
274 | v1: bus_addr, v2: len); |
275 | } |
276 | |
277 | int ps3_repository_read_dev_reg(unsigned int bus_index, |
278 | unsigned int dev_index, unsigned int reg_index, |
279 | enum ps3_reg_type *reg_type, u64 *bus_addr, u64 *len) |
280 | { |
281 | int result = ps3_repository_read_dev_reg_type(bus_index, dev_index, |
282 | reg_index, reg_type); |
283 | return result ? result |
284 | : ps3_repository_read_dev_reg_addr(bus_index, dev_index, |
285 | reg_index, bus_addr, len); |
286 | } |
287 | |
288 | |
289 | |
290 | int ps3_repository_find_device(struct ps3_repository_device *repo) |
291 | { |
292 | int result; |
293 | struct ps3_repository_device tmp = *repo; |
294 | unsigned int num_dev; |
295 | |
296 | BUG_ON(repo->bus_index > 10); |
297 | BUG_ON(repo->dev_index > 10); |
298 | |
299 | result = ps3_repository_read_bus_num_dev(bus_index: tmp.bus_index, num_dev: &num_dev); |
300 | |
301 | if (result) { |
302 | pr_devel("%s:%d read_bus_num_dev failed\n" , __func__, __LINE__); |
303 | return result; |
304 | } |
305 | |
306 | pr_devel("%s:%d: bus_type %u, bus_index %u, bus_id %llu, num_dev %u\n" , |
307 | __func__, __LINE__, tmp.bus_type, tmp.bus_index, tmp.bus_id, |
308 | num_dev); |
309 | |
310 | if (tmp.dev_index >= num_dev) { |
311 | pr_devel("%s:%d: no device found\n" , __func__, __LINE__); |
312 | return -ENODEV; |
313 | } |
314 | |
315 | result = ps3_repository_read_dev_type(bus_index: tmp.bus_index, dev_index: tmp.dev_index, |
316 | dev_type: &tmp.dev_type); |
317 | |
318 | if (result) { |
319 | pr_devel("%s:%d read_dev_type failed\n" , __func__, __LINE__); |
320 | return result; |
321 | } |
322 | |
323 | result = ps3_repository_read_dev_id(bus_index: tmp.bus_index, dev_index: tmp.dev_index, |
324 | dev_id: &tmp.dev_id); |
325 | |
326 | if (result) { |
327 | pr_devel("%s:%d ps3_repository_read_dev_id failed\n" , __func__, |
328 | __LINE__); |
329 | return result; |
330 | } |
331 | |
332 | pr_devel("%s:%d: found: dev_type %u, dev_index %u, dev_id %llu\n" , |
333 | __func__, __LINE__, tmp.dev_type, tmp.dev_index, tmp.dev_id); |
334 | |
335 | *repo = tmp; |
336 | return 0; |
337 | } |
338 | |
339 | int ps3_repository_find_device_by_id(struct ps3_repository_device *repo, |
340 | u64 bus_id, u64 dev_id) |
341 | { |
342 | int result = -ENODEV; |
343 | struct ps3_repository_device tmp; |
344 | unsigned int num_dev; |
345 | |
346 | pr_devel(" -> %s:%u: find device by id %llu:%llu\n" , __func__, __LINE__, |
347 | bus_id, dev_id); |
348 | |
349 | for (tmp.bus_index = 0; tmp.bus_index < 10; tmp.bus_index++) { |
350 | result = ps3_repository_read_bus_id(bus_index: tmp.bus_index, |
351 | bus_id: &tmp.bus_id); |
352 | if (result) { |
353 | pr_devel("%s:%u read_bus_id(%u) failed\n" , __func__, |
354 | __LINE__, tmp.bus_index); |
355 | return result; |
356 | } |
357 | |
358 | if (tmp.bus_id == bus_id) |
359 | goto found_bus; |
360 | |
361 | pr_devel("%s:%u: skip, bus_id %llu\n" , __func__, __LINE__, |
362 | tmp.bus_id); |
363 | } |
364 | pr_devel(" <- %s:%u: bus not found\n" , __func__, __LINE__); |
365 | return result; |
366 | |
367 | found_bus: |
368 | result = ps3_repository_read_bus_type(bus_index: tmp.bus_index, bus_type: &tmp.bus_type); |
369 | if (result) { |
370 | pr_devel("%s:%u read_bus_type(%u) failed\n" , __func__, |
371 | __LINE__, tmp.bus_index); |
372 | return result; |
373 | } |
374 | |
375 | result = ps3_repository_read_bus_num_dev(bus_index: tmp.bus_index, num_dev: &num_dev); |
376 | if (result) { |
377 | pr_devel("%s:%u read_bus_num_dev failed\n" , __func__, |
378 | __LINE__); |
379 | return result; |
380 | } |
381 | |
382 | for (tmp.dev_index = 0; tmp.dev_index < num_dev; tmp.dev_index++) { |
383 | result = ps3_repository_read_dev_id(bus_index: tmp.bus_index, |
384 | dev_index: tmp.dev_index, |
385 | dev_id: &tmp.dev_id); |
386 | if (result) { |
387 | pr_devel("%s:%u read_dev_id(%u:%u) failed\n" , __func__, |
388 | __LINE__, tmp.bus_index, tmp.dev_index); |
389 | return result; |
390 | } |
391 | |
392 | if (tmp.dev_id == dev_id) |
393 | goto found_dev; |
394 | |
395 | pr_devel("%s:%u: skip, dev_id %llu\n" , __func__, __LINE__, |
396 | tmp.dev_id); |
397 | } |
398 | pr_devel(" <- %s:%u: dev not found\n" , __func__, __LINE__); |
399 | return result; |
400 | |
401 | found_dev: |
402 | result = ps3_repository_read_dev_type(bus_index: tmp.bus_index, dev_index: tmp.dev_index, |
403 | dev_type: &tmp.dev_type); |
404 | if (result) { |
405 | pr_devel("%s:%u read_dev_type failed\n" , __func__, __LINE__); |
406 | return result; |
407 | } |
408 | |
409 | pr_devel(" <- %s:%u: found: type (%u:%u) index (%u:%u) id (%llu:%llu)\n" , |
410 | __func__, __LINE__, tmp.bus_type, tmp.dev_type, tmp.bus_index, |
411 | tmp.dev_index, tmp.bus_id, tmp.dev_id); |
412 | *repo = tmp; |
413 | return 0; |
414 | } |
415 | |
416 | int __init ps3_repository_find_devices(enum ps3_bus_type bus_type, |
417 | int (*callback)(const struct ps3_repository_device *repo)) |
418 | { |
419 | int result = 0; |
420 | struct ps3_repository_device repo; |
421 | |
422 | pr_devel(" -> %s:%d: find bus_type %u\n" , __func__, __LINE__, bus_type); |
423 | |
424 | repo.bus_type = bus_type; |
425 | result = ps3_repository_find_bus(bus_type: repo.bus_type, from: 0, bus_index: &repo.bus_index); |
426 | if (result) { |
427 | pr_devel(" <- %s:%u: bus not found\n" , __func__, __LINE__); |
428 | return result; |
429 | } |
430 | |
431 | result = ps3_repository_read_bus_id(bus_index: repo.bus_index, bus_id: &repo.bus_id); |
432 | if (result) { |
433 | pr_devel("%s:%d read_bus_id(%u) failed\n" , __func__, __LINE__, |
434 | repo.bus_index); |
435 | return result; |
436 | } |
437 | |
438 | for (repo.dev_index = 0; ; repo.dev_index++) { |
439 | result = ps3_repository_find_device(repo: &repo); |
440 | if (result == -ENODEV) { |
441 | result = 0; |
442 | break; |
443 | } else if (result) |
444 | break; |
445 | |
446 | result = callback(&repo); |
447 | if (result) { |
448 | pr_devel("%s:%d: abort at callback\n" , __func__, |
449 | __LINE__); |
450 | break; |
451 | } |
452 | } |
453 | |
454 | pr_devel(" <- %s:%d\n" , __func__, __LINE__); |
455 | return result; |
456 | } |
457 | |
458 | int __init ps3_repository_find_bus(enum ps3_bus_type bus_type, unsigned int from, |
459 | unsigned int *bus_index) |
460 | { |
461 | unsigned int i; |
462 | enum ps3_bus_type type; |
463 | int error; |
464 | |
465 | for (i = from; i < 10; i++) { |
466 | error = ps3_repository_read_bus_type(bus_index: i, bus_type: &type); |
467 | if (error) { |
468 | pr_devel("%s:%d read_bus_type failed\n" , |
469 | __func__, __LINE__); |
470 | *bus_index = UINT_MAX; |
471 | return error; |
472 | } |
473 | if (type == bus_type) { |
474 | *bus_index = i; |
475 | return 0; |
476 | } |
477 | } |
478 | *bus_index = UINT_MAX; |
479 | return -ENODEV; |
480 | } |
481 | |
482 | int ps3_repository_find_interrupt(const struct ps3_repository_device *repo, |
483 | enum ps3_interrupt_type intr_type, unsigned int *interrupt_id) |
484 | { |
485 | int result = 0; |
486 | unsigned int res_index; |
487 | |
488 | pr_devel("%s:%d: find intr_type %u\n" , __func__, __LINE__, intr_type); |
489 | |
490 | *interrupt_id = UINT_MAX; |
491 | |
492 | for (res_index = 0; res_index < 10; res_index++) { |
493 | enum ps3_interrupt_type t; |
494 | unsigned int id; |
495 | |
496 | result = ps3_repository_read_dev_intr(bus_index: repo->bus_index, |
497 | dev_index: repo->dev_index, intr_index: res_index, intr_type: &t, interrupt_id: &id); |
498 | |
499 | if (result) { |
500 | pr_devel("%s:%d read_dev_intr failed\n" , |
501 | __func__, __LINE__); |
502 | return result; |
503 | } |
504 | |
505 | if (t == intr_type) { |
506 | *interrupt_id = id; |
507 | break; |
508 | } |
509 | } |
510 | |
511 | if (res_index == 10) |
512 | return -ENODEV; |
513 | |
514 | pr_devel("%s:%d: found intr_type %u at res_index %u\n" , |
515 | __func__, __LINE__, intr_type, res_index); |
516 | |
517 | return result; |
518 | } |
519 | |
520 | int ps3_repository_find_reg(const struct ps3_repository_device *repo, |
521 | enum ps3_reg_type reg_type, u64 *bus_addr, u64 *len) |
522 | { |
523 | int result = 0; |
524 | unsigned int res_index; |
525 | |
526 | pr_devel("%s:%d: find reg_type %u\n" , __func__, __LINE__, reg_type); |
527 | |
528 | *bus_addr = *len = 0; |
529 | |
530 | for (res_index = 0; res_index < 10; res_index++) { |
531 | enum ps3_reg_type t; |
532 | u64 a; |
533 | u64 l; |
534 | |
535 | result = ps3_repository_read_dev_reg(bus_index: repo->bus_index, |
536 | dev_index: repo->dev_index, reg_index: res_index, reg_type: &t, bus_addr: &a, len: &l); |
537 | |
538 | if (result) { |
539 | pr_devel("%s:%d read_dev_reg failed\n" , |
540 | __func__, __LINE__); |
541 | return result; |
542 | } |
543 | |
544 | if (t == reg_type) { |
545 | *bus_addr = a; |
546 | *len = l; |
547 | break; |
548 | } |
549 | } |
550 | |
551 | if (res_index == 10) |
552 | return -ENODEV; |
553 | |
554 | pr_devel("%s:%d: found reg_type %u at res_index %u\n" , |
555 | __func__, __LINE__, reg_type, res_index); |
556 | |
557 | return result; |
558 | } |
559 | |
560 | int ps3_repository_read_stor_dev_port(unsigned int bus_index, |
561 | unsigned int dev_index, u64 *port) |
562 | { |
563 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
564 | n1: make_first_field(text: "bus" , index: bus_index), |
565 | n2: make_field(text: "dev" , index: dev_index), |
566 | n3: make_field(text: "port" , index: 0), |
567 | n4: 0, v1: port, NULL); |
568 | } |
569 | |
570 | int ps3_repository_read_stor_dev_blk_size(unsigned int bus_index, |
571 | unsigned int dev_index, u64 *blk_size) |
572 | { |
573 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
574 | n1: make_first_field(text: "bus" , index: bus_index), |
575 | n2: make_field(text: "dev" , index: dev_index), |
576 | n3: make_field(text: "blk_size" , index: 0), |
577 | n4: 0, v1: blk_size, NULL); |
578 | } |
579 | |
580 | int ps3_repository_read_stor_dev_num_blocks(unsigned int bus_index, |
581 | unsigned int dev_index, u64 *num_blocks) |
582 | { |
583 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
584 | n1: make_first_field(text: "bus" , index: bus_index), |
585 | n2: make_field(text: "dev" , index: dev_index), |
586 | n3: make_field(text: "n_blocks" , index: 0), |
587 | n4: 0, v1: num_blocks, NULL); |
588 | } |
589 | |
590 | int ps3_repository_read_stor_dev_num_regions(unsigned int bus_index, |
591 | unsigned int dev_index, unsigned int *num_regions) |
592 | { |
593 | int result; |
594 | u64 v1 = 0; |
595 | |
596 | result = read_node(lpar_id: PS3_LPAR_ID_PME, |
597 | n1: make_first_field(text: "bus" , index: bus_index), |
598 | n2: make_field(text: "dev" , index: dev_index), |
599 | n3: make_field(text: "n_regs" , index: 0), |
600 | n4: 0, v1: &v1, NULL); |
601 | *num_regions = v1; |
602 | return result; |
603 | } |
604 | |
605 | int ps3_repository_read_stor_dev_region_id(unsigned int bus_index, |
606 | unsigned int dev_index, unsigned int region_index, |
607 | unsigned int *region_id) |
608 | { |
609 | int result; |
610 | u64 v1 = 0; |
611 | |
612 | result = read_node(lpar_id: PS3_LPAR_ID_PME, |
613 | n1: make_first_field(text: "bus" , index: bus_index), |
614 | n2: make_field(text: "dev" , index: dev_index), |
615 | n3: make_field(text: "region" , index: region_index), |
616 | n4: make_field(text: "id" , index: 0), |
617 | v1: &v1, NULL); |
618 | *region_id = v1; |
619 | return result; |
620 | } |
621 | |
622 | int ps3_repository_read_stor_dev_region_size(unsigned int bus_index, |
623 | unsigned int dev_index, unsigned int region_index, u64 *region_size) |
624 | { |
625 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
626 | n1: make_first_field(text: "bus" , index: bus_index), |
627 | n2: make_field(text: "dev" , index: dev_index), |
628 | n3: make_field(text: "region" , index: region_index), |
629 | n4: make_field(text: "size" , index: 0), |
630 | v1: region_size, NULL); |
631 | } |
632 | |
633 | int ps3_repository_read_stor_dev_region_start(unsigned int bus_index, |
634 | unsigned int dev_index, unsigned int region_index, u64 *region_start) |
635 | { |
636 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
637 | n1: make_first_field(text: "bus" , index: bus_index), |
638 | n2: make_field(text: "dev" , index: dev_index), |
639 | n3: make_field(text: "region" , index: region_index), |
640 | n4: make_field(text: "start" , index: 0), |
641 | v1: region_start, NULL); |
642 | } |
643 | |
644 | int ps3_repository_read_stor_dev_info(unsigned int bus_index, |
645 | unsigned int dev_index, u64 *port, u64 *blk_size, |
646 | u64 *num_blocks, unsigned int *num_regions) |
647 | { |
648 | int result; |
649 | |
650 | result = ps3_repository_read_stor_dev_port(bus_index, dev_index, port); |
651 | if (result) |
652 | return result; |
653 | |
654 | result = ps3_repository_read_stor_dev_blk_size(bus_index, dev_index, |
655 | blk_size); |
656 | if (result) |
657 | return result; |
658 | |
659 | result = ps3_repository_read_stor_dev_num_blocks(bus_index, dev_index, |
660 | num_blocks); |
661 | if (result) |
662 | return result; |
663 | |
664 | result = ps3_repository_read_stor_dev_num_regions(bus_index, dev_index, |
665 | num_regions); |
666 | return result; |
667 | } |
668 | |
669 | int ps3_repository_read_stor_dev_region(unsigned int bus_index, |
670 | unsigned int dev_index, unsigned int region_index, |
671 | unsigned int *region_id, u64 *region_start, u64 *region_size) |
672 | { |
673 | int result; |
674 | |
675 | result = ps3_repository_read_stor_dev_region_id(bus_index, dev_index, |
676 | region_index, region_id); |
677 | if (result) |
678 | return result; |
679 | |
680 | result = ps3_repository_read_stor_dev_region_start(bus_index, dev_index, |
681 | region_index, region_start); |
682 | if (result) |
683 | return result; |
684 | |
685 | result = ps3_repository_read_stor_dev_region_size(bus_index, dev_index, |
686 | region_index, region_size); |
687 | return result; |
688 | } |
689 | |
690 | /** |
691 | * ps3_repository_read_num_pu - Number of logical PU processors for this lpar. |
692 | */ |
693 | |
694 | int ps3_repository_read_num_pu(u64 *num_pu) |
695 | { |
696 | *num_pu = 0; |
697 | return read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
698 | n1: make_first_field(text: "bi" , index: 0), |
699 | n2: make_field(text: "pun" , index: 0), |
700 | n3: 0, n4: 0, |
701 | v1: num_pu, NULL); |
702 | } |
703 | |
704 | /** |
705 | * ps3_repository_read_pu_id - Read the logical PU id. |
706 | * @pu_index: Zero based index. |
707 | * @pu_id: The logical PU id. |
708 | */ |
709 | |
710 | int ps3_repository_read_pu_id(unsigned int pu_index, u64 *pu_id) |
711 | { |
712 | return read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
713 | n1: make_first_field(text: "bi" , index: 0), |
714 | n2: make_field(text: "pu" , index: pu_index), |
715 | n3: 0, n4: 0, |
716 | v1: pu_id, NULL); |
717 | } |
718 | |
719 | int ps3_repository_read_rm_size(unsigned int ppe_id, u64 *rm_size) |
720 | { |
721 | return read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
722 | n1: make_first_field(text: "bi" , index: 0), |
723 | n2: make_field(text: "pu" , index: 0), |
724 | n3: ppe_id, |
725 | n4: make_field(text: "rm_size" , index: 0), |
726 | v1: rm_size, NULL); |
727 | } |
728 | |
729 | int ps3_repository_read_region_total(u64 *region_total) |
730 | { |
731 | return read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
732 | n1: make_first_field(text: "bi" , index: 0), |
733 | n2: make_field(text: "rgntotal" , index: 0), |
734 | n3: 0, n4: 0, |
735 | v1: region_total, NULL); |
736 | } |
737 | |
738 | /** |
739 | * ps3_repository_read_mm_info - Read mm info for single pu system. |
740 | * @rm_base: Real mode memory base address. |
741 | * @rm_size: Real mode memory size. |
742 | * @region_total: Maximum memory region size. |
743 | */ |
744 | |
745 | int ps3_repository_read_mm_info(u64 *rm_base, u64 *rm_size, u64 *region_total) |
746 | { |
747 | int result; |
748 | u64 ppe_id; |
749 | |
750 | lv1_get_logical_ppe_id(&ppe_id); |
751 | *rm_base = 0; |
752 | result = ps3_repository_read_rm_size(ppe_id, rm_size); |
753 | return result ? result |
754 | : ps3_repository_read_region_total(region_total); |
755 | } |
756 | |
757 | /** |
758 | * ps3_repository_read_highmem_region_count - Read the number of highmem regions |
759 | * |
760 | * Bootloaders must arrange the repository nodes such that regions are indexed |
761 | * with a region_index from 0 to region_count-1. |
762 | */ |
763 | |
764 | int ps3_repository_read_highmem_region_count(unsigned int *region_count) |
765 | { |
766 | int result; |
767 | u64 v1 = 0; |
768 | |
769 | result = read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
770 | n1: make_first_field(text: "highmem" , index: 0), |
771 | n2: make_field(text: "region" , index: 0), |
772 | n3: make_field(text: "count" , index: 0), |
773 | n4: 0, |
774 | v1: &v1, NULL); |
775 | *region_count = v1; |
776 | return result; |
777 | } |
778 | |
779 | |
780 | int ps3_repository_read_highmem_base(unsigned int region_index, |
781 | u64 *highmem_base) |
782 | { |
783 | return read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
784 | n1: make_first_field(text: "highmem" , index: 0), |
785 | n2: make_field(text: "region" , index: region_index), |
786 | n3: make_field(text: "base" , index: 0), |
787 | n4: 0, |
788 | v1: highmem_base, NULL); |
789 | } |
790 | |
791 | int ps3_repository_read_highmem_size(unsigned int region_index, |
792 | u64 *highmem_size) |
793 | { |
794 | return read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
795 | n1: make_first_field(text: "highmem" , index: 0), |
796 | n2: make_field(text: "region" , index: region_index), |
797 | n3: make_field(text: "size" , index: 0), |
798 | n4: 0, |
799 | v1: highmem_size, NULL); |
800 | } |
801 | |
802 | /** |
803 | * ps3_repository_read_highmem_info - Read high memory region info |
804 | * @region_index: Region index, {0,..,region_count-1}. |
805 | * @highmem_base: High memory base address. |
806 | * @highmem_size: High memory size. |
807 | * |
808 | * Bootloaders that preallocate highmem regions must place the |
809 | * region info into the repository at these well known nodes. |
810 | */ |
811 | |
812 | int ps3_repository_read_highmem_info(unsigned int region_index, |
813 | u64 *highmem_base, u64 *highmem_size) |
814 | { |
815 | int result; |
816 | |
817 | *highmem_base = 0; |
818 | result = ps3_repository_read_highmem_base(region_index, highmem_base); |
819 | return result ? result |
820 | : ps3_repository_read_highmem_size(region_index, highmem_size); |
821 | } |
822 | |
823 | /** |
824 | * ps3_repository_read_num_spu_reserved - Number of physical spus reserved. |
825 | * @num_spu: Number of physical spus. |
826 | */ |
827 | |
828 | int ps3_repository_read_num_spu_reserved(unsigned int *num_spu_reserved) |
829 | { |
830 | int result; |
831 | u64 v1 = 0; |
832 | |
833 | result = read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
834 | n1: make_first_field(text: "bi" , index: 0), |
835 | n2: make_field(text: "spun" , index: 0), |
836 | n3: 0, n4: 0, |
837 | v1: &v1, NULL); |
838 | *num_spu_reserved = v1; |
839 | return result; |
840 | } |
841 | |
842 | /** |
843 | * ps3_repository_read_num_spu_resource_id - Number of spu resource reservations. |
844 | * @num_resource_id: Number of spu resource ids. |
845 | */ |
846 | |
847 | int ps3_repository_read_num_spu_resource_id(unsigned int *num_resource_id) |
848 | { |
849 | int result; |
850 | u64 v1 = 0; |
851 | |
852 | result = read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
853 | n1: make_first_field(text: "bi" , index: 0), |
854 | n2: make_field(text: "spursvn" , index: 0), |
855 | n3: 0, n4: 0, |
856 | v1: &v1, NULL); |
857 | *num_resource_id = v1; |
858 | return result; |
859 | } |
860 | |
861 | /** |
862 | * ps3_repository_read_spu_resource_id - spu resource reservation id value. |
863 | * @res_index: Resource reservation index. |
864 | * @resource_type: Resource reservation type. |
865 | * @resource_id: Resource reservation id. |
866 | */ |
867 | |
868 | int ps3_repository_read_spu_resource_id(unsigned int res_index, |
869 | enum ps3_spu_resource_type *resource_type, unsigned int *resource_id) |
870 | { |
871 | int result; |
872 | u64 v1 = 0; |
873 | u64 v2 = 0; |
874 | |
875 | result = read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
876 | n1: make_first_field(text: "bi" , index: 0), |
877 | n2: make_field(text: "spursv" , index: 0), |
878 | n3: res_index, |
879 | n4: 0, |
880 | v1: &v1, v2: &v2); |
881 | *resource_type = v1; |
882 | *resource_id = v2; |
883 | return result; |
884 | } |
885 | |
886 | static int ps3_repository_read_boot_dat_address(u64 *address) |
887 | { |
888 | return read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
889 | n1: make_first_field(text: "bi" , index: 0), |
890 | n2: make_field(text: "boot_dat" , index: 0), |
891 | n3: make_field(text: "address" , index: 0), |
892 | n4: 0, |
893 | v1: address, NULL); |
894 | } |
895 | |
896 | int ps3_repository_read_boot_dat_size(unsigned int *size) |
897 | { |
898 | int result; |
899 | u64 v1 = 0; |
900 | |
901 | result = read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
902 | n1: make_first_field(text: "bi" , index: 0), |
903 | n2: make_field(text: "boot_dat" , index: 0), |
904 | n3: make_field(text: "size" , index: 0), |
905 | n4: 0, |
906 | v1: &v1, NULL); |
907 | *size = v1; |
908 | return result; |
909 | } |
910 | |
911 | int __init ps3_repository_read_vuart_av_port(unsigned int *port) |
912 | { |
913 | int result; |
914 | u64 v1 = 0; |
915 | |
916 | result = read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
917 | n1: make_first_field(text: "bi" , index: 0), |
918 | n2: make_field(text: "vir_uart" , index: 0), |
919 | n3: make_field(text: "port" , index: 0), |
920 | n4: make_field(text: "avset" , index: 0), |
921 | v1: &v1, NULL); |
922 | *port = v1; |
923 | return result; |
924 | } |
925 | |
926 | int __init ps3_repository_read_vuart_sysmgr_port(unsigned int *port) |
927 | { |
928 | int result; |
929 | u64 v1 = 0; |
930 | |
931 | result = read_node(lpar_id: PS3_LPAR_ID_CURRENT, |
932 | n1: make_first_field(text: "bi" , index: 0), |
933 | n2: make_field(text: "vir_uart" , index: 0), |
934 | n3: make_field(text: "port" , index: 0), |
935 | n4: make_field(text: "sysmgr" , index: 0), |
936 | v1: &v1, NULL); |
937 | *port = v1; |
938 | return result; |
939 | } |
940 | |
941 | /** |
942 | * ps3_repository_read_boot_dat_info - Get address and size of cell_ext_os_area. |
943 | * address: lpar address of cell_ext_os_area |
944 | * @size: size of cell_ext_os_area |
945 | */ |
946 | |
947 | int ps3_repository_read_boot_dat_info(u64 *lpar_addr, unsigned int *size) |
948 | { |
949 | int result; |
950 | |
951 | *size = 0; |
952 | result = ps3_repository_read_boot_dat_address(address: lpar_addr); |
953 | return result ? result |
954 | : ps3_repository_read_boot_dat_size(size); |
955 | } |
956 | |
957 | /** |
958 | * ps3_repository_read_num_be - Number of physical BE processors in the system. |
959 | */ |
960 | |
961 | int ps3_repository_read_num_be(unsigned int *num_be) |
962 | { |
963 | int result; |
964 | u64 v1 = 0; |
965 | |
966 | result = read_node(lpar_id: PS3_LPAR_ID_PME, |
967 | n1: make_first_field(text: "ben" , index: 0), |
968 | n2: 0, |
969 | n3: 0, |
970 | n4: 0, |
971 | v1: &v1, NULL); |
972 | *num_be = v1; |
973 | return result; |
974 | } |
975 | |
976 | /** |
977 | * ps3_repository_read_be_node_id - Read the physical BE processor node id. |
978 | * @be_index: Zero based index. |
979 | * @node_id: The BE processor node id. |
980 | */ |
981 | |
982 | int ps3_repository_read_be_node_id(unsigned int be_index, u64 *node_id) |
983 | { |
984 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
985 | n1: make_first_field(text: "be" , index: be_index), |
986 | n2: 0, |
987 | n3: 0, |
988 | n4: 0, |
989 | v1: node_id, NULL); |
990 | } |
991 | |
992 | /** |
993 | * ps3_repository_read_be_id - Read the physical BE processor id. |
994 | * @node_id: The BE processor node id. |
995 | * @be_id: The BE processor id. |
996 | */ |
997 | |
998 | int ps3_repository_read_be_id(u64 node_id, u64 *be_id) |
999 | { |
1000 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
1001 | n1: make_first_field(text: "be" , index: 0), |
1002 | n2: node_id, |
1003 | n3: 0, |
1004 | n4: 0, |
1005 | v1: be_id, NULL); |
1006 | } |
1007 | |
1008 | int __init ps3_repository_read_tb_freq(u64 node_id, u64 *tb_freq) |
1009 | { |
1010 | return read_node(lpar_id: PS3_LPAR_ID_PME, |
1011 | n1: make_first_field(text: "be" , index: 0), |
1012 | n2: node_id, |
1013 | n3: make_field(text: "clock" , index: 0), |
1014 | n4: 0, |
1015 | v1: tb_freq, NULL); |
1016 | } |
1017 | |
1018 | int __init ps3_repository_read_be_tb_freq(unsigned int be_index, u64 *tb_freq) |
1019 | { |
1020 | int result; |
1021 | u64 node_id; |
1022 | |
1023 | *tb_freq = 0; |
1024 | result = ps3_repository_read_be_node_id(be_index, node_id: &node_id); |
1025 | return result ? result |
1026 | : ps3_repository_read_tb_freq(node_id, tb_freq); |
1027 | } |
1028 | |
1029 | int ps3_repository_read_lpm_privileges(unsigned int be_index, u64 *lpar, |
1030 | u64 *rights) |
1031 | { |
1032 | int result; |
1033 | u64 node_id; |
1034 | |
1035 | *lpar = 0; |
1036 | *rights = 0; |
1037 | result = ps3_repository_read_be_node_id(be_index, node_id: &node_id); |
1038 | return result ? result |
1039 | : read_node(lpar_id: PS3_LPAR_ID_PME, |
1040 | n1: make_first_field(text: "be" , index: 0), |
1041 | n2: node_id, |
1042 | n3: make_field(text: "lpm" , index: 0), |
1043 | n4: make_field(text: "priv" , index: 0), |
1044 | v1: lpar, v2: rights); |
1045 | } |
1046 | |
1047 | #if defined(CONFIG_PS3_REPOSITORY_WRITE) |
1048 | |
1049 | static int create_node(u64 n1, u64 n2, u64 n3, u64 n4, u64 v1, u64 v2) |
1050 | { |
1051 | int result; |
1052 | |
1053 | dump_node(0, n1, n2, n3, n4, v1, v2); |
1054 | |
1055 | result = lv1_create_repository_node(n1, n2, n3, n4, v1, v2); |
1056 | |
1057 | if (result) { |
1058 | pr_devel("%s:%d: lv1_create_repository_node failed: %s\n" , |
1059 | __func__, __LINE__, ps3_result(result)); |
1060 | return -ENOENT; |
1061 | } |
1062 | |
1063 | return 0; |
1064 | } |
1065 | |
1066 | static int delete_node(u64 n1, u64 n2, u64 n3, u64 n4) |
1067 | { |
1068 | int result; |
1069 | |
1070 | dump_node(0, n1, n2, n3, n4, 0, 0); |
1071 | |
1072 | result = lv1_delete_repository_node(n1, n2, n3, n4); |
1073 | |
1074 | if (result) { |
1075 | pr_devel("%s:%d: lv1_delete_repository_node failed: %s\n" , |
1076 | __func__, __LINE__, ps3_result(result)); |
1077 | return -ENOENT; |
1078 | } |
1079 | |
1080 | return 0; |
1081 | } |
1082 | |
1083 | static int write_node(u64 n1, u64 n2, u64 n3, u64 n4, u64 v1, u64 v2) |
1084 | { |
1085 | int result; |
1086 | |
1087 | result = create_node(n1, n2, n3, n4, v1, v2); |
1088 | |
1089 | if (!result) |
1090 | return 0; |
1091 | |
1092 | result = lv1_write_repository_node(n1, n2, n3, n4, v1, v2); |
1093 | |
1094 | if (result) { |
1095 | pr_devel("%s:%d: lv1_write_repository_node failed: %s\n" , |
1096 | __func__, __LINE__, ps3_result(result)); |
1097 | return -ENOENT; |
1098 | } |
1099 | |
1100 | return 0; |
1101 | } |
1102 | |
1103 | int ps3_repository_write_highmem_region_count(unsigned int region_count) |
1104 | { |
1105 | int result; |
1106 | u64 v1 = (u64)region_count; |
1107 | |
1108 | result = write_node( |
1109 | make_first_field("highmem" , 0), |
1110 | make_field("region" , 0), |
1111 | make_field("count" , 0), |
1112 | 0, |
1113 | v1, 0); |
1114 | return result; |
1115 | } |
1116 | |
1117 | int ps3_repository_write_highmem_base(unsigned int region_index, |
1118 | u64 highmem_base) |
1119 | { |
1120 | return write_node( |
1121 | make_first_field("highmem" , 0), |
1122 | make_field("region" , region_index), |
1123 | make_field("base" , 0), |
1124 | 0, |
1125 | highmem_base, 0); |
1126 | } |
1127 | |
1128 | int ps3_repository_write_highmem_size(unsigned int region_index, |
1129 | u64 highmem_size) |
1130 | { |
1131 | return write_node( |
1132 | make_first_field("highmem" , 0), |
1133 | make_field("region" , region_index), |
1134 | make_field("size" , 0), |
1135 | 0, |
1136 | highmem_size, 0); |
1137 | } |
1138 | |
1139 | int ps3_repository_write_highmem_info(unsigned int region_index, |
1140 | u64 highmem_base, u64 highmem_size) |
1141 | { |
1142 | int result; |
1143 | |
1144 | result = ps3_repository_write_highmem_base(region_index, highmem_base); |
1145 | return result ? result |
1146 | : ps3_repository_write_highmem_size(region_index, highmem_size); |
1147 | } |
1148 | |
1149 | static int ps3_repository_delete_highmem_base(unsigned int region_index) |
1150 | { |
1151 | return delete_node( |
1152 | make_first_field("highmem" , 0), |
1153 | make_field("region" , region_index), |
1154 | make_field("base" , 0), |
1155 | 0); |
1156 | } |
1157 | |
1158 | static int ps3_repository_delete_highmem_size(unsigned int region_index) |
1159 | { |
1160 | return delete_node( |
1161 | make_first_field("highmem" , 0), |
1162 | make_field("region" , region_index), |
1163 | make_field("size" , 0), |
1164 | 0); |
1165 | } |
1166 | |
1167 | int ps3_repository_delete_highmem_info(unsigned int region_index) |
1168 | { |
1169 | int result; |
1170 | |
1171 | result = ps3_repository_delete_highmem_base(region_index); |
1172 | result += ps3_repository_delete_highmem_size(region_index); |
1173 | |
1174 | return result ? -1 : 0; |
1175 | } |
1176 | |
1177 | #endif /* defined(CONFIG_PS3_REPOSITORY_WRITE) */ |
1178 | |
1179 | #if defined(DEBUG) |
1180 | |
1181 | int __init ps3_repository_dump_resource_info(const struct ps3_repository_device *repo) |
1182 | { |
1183 | int result = 0; |
1184 | unsigned int res_index; |
1185 | |
1186 | pr_devel(" -> %s:%d: (%u:%u)\n" , __func__, __LINE__, |
1187 | repo->bus_index, repo->dev_index); |
1188 | |
1189 | for (res_index = 0; res_index < 10; res_index++) { |
1190 | enum ps3_interrupt_type intr_type; |
1191 | unsigned int interrupt_id; |
1192 | |
1193 | result = ps3_repository_read_dev_intr(repo->bus_index, |
1194 | repo->dev_index, res_index, &intr_type, &interrupt_id); |
1195 | |
1196 | if (result) { |
1197 | if (result != LV1_NO_ENTRY) |
1198 | pr_devel("%s:%d ps3_repository_read_dev_intr" |
1199 | " (%u:%u) failed\n" , __func__, __LINE__, |
1200 | repo->bus_index, repo->dev_index); |
1201 | break; |
1202 | } |
1203 | |
1204 | pr_devel("%s:%d (%u:%u) intr_type %u, interrupt_id %u\n" , |
1205 | __func__, __LINE__, repo->bus_index, repo->dev_index, |
1206 | intr_type, interrupt_id); |
1207 | } |
1208 | |
1209 | for (res_index = 0; res_index < 10; res_index++) { |
1210 | enum ps3_reg_type reg_type; |
1211 | u64 bus_addr; |
1212 | u64 len; |
1213 | |
1214 | result = ps3_repository_read_dev_reg(repo->bus_index, |
1215 | repo->dev_index, res_index, ®_type, &bus_addr, &len); |
1216 | |
1217 | if (result) { |
1218 | if (result != LV1_NO_ENTRY) |
1219 | pr_devel("%s:%d ps3_repository_read_dev_reg" |
1220 | " (%u:%u) failed\n" , __func__, __LINE__, |
1221 | repo->bus_index, repo->dev_index); |
1222 | break; |
1223 | } |
1224 | |
1225 | pr_devel("%s:%d (%u:%u) reg_type %u, bus_addr %llxh, len %llxh\n" , |
1226 | __func__, __LINE__, repo->bus_index, repo->dev_index, |
1227 | reg_type, bus_addr, len); |
1228 | } |
1229 | |
1230 | pr_devel(" <- %s:%d\n" , __func__, __LINE__); |
1231 | return result; |
1232 | } |
1233 | |
1234 | static int __init dump_stor_dev_info(struct ps3_repository_device *repo) |
1235 | { |
1236 | int result = 0; |
1237 | unsigned int num_regions, region_index; |
1238 | u64 port, blk_size, num_blocks; |
1239 | |
1240 | pr_devel(" -> %s:%d: (%u:%u)\n" , __func__, __LINE__, |
1241 | repo->bus_index, repo->dev_index); |
1242 | |
1243 | result = ps3_repository_read_stor_dev_info(repo->bus_index, |
1244 | repo->dev_index, &port, &blk_size, &num_blocks, &num_regions); |
1245 | if (result) { |
1246 | pr_devel("%s:%d ps3_repository_read_stor_dev_info" |
1247 | " (%u:%u) failed\n" , __func__, __LINE__, |
1248 | repo->bus_index, repo->dev_index); |
1249 | goto out; |
1250 | } |
1251 | |
1252 | pr_devel("%s:%d (%u:%u): port %llu, blk_size %llu, num_blocks " |
1253 | "%llu, num_regions %u\n" , |
1254 | __func__, __LINE__, repo->bus_index, repo->dev_index, |
1255 | port, blk_size, num_blocks, num_regions); |
1256 | |
1257 | for (region_index = 0; region_index < num_regions; region_index++) { |
1258 | unsigned int region_id; |
1259 | u64 region_start, region_size; |
1260 | |
1261 | result = ps3_repository_read_stor_dev_region(repo->bus_index, |
1262 | repo->dev_index, region_index, ®ion_id, |
1263 | ®ion_start, ®ion_size); |
1264 | if (result) { |
1265 | pr_devel("%s:%d ps3_repository_read_stor_dev_region" |
1266 | " (%u:%u) failed\n" , __func__, __LINE__, |
1267 | repo->bus_index, repo->dev_index); |
1268 | break; |
1269 | } |
1270 | |
1271 | pr_devel("%s:%d (%u:%u) region_id %u, start %lxh, size %lxh\n" , |
1272 | __func__, __LINE__, repo->bus_index, repo->dev_index, |
1273 | region_id, (unsigned long)region_start, |
1274 | (unsigned long)region_size); |
1275 | } |
1276 | |
1277 | out: |
1278 | pr_devel(" <- %s:%d\n" , __func__, __LINE__); |
1279 | return result; |
1280 | } |
1281 | |
1282 | static int __init dump_device_info(struct ps3_repository_device *repo, |
1283 | unsigned int num_dev) |
1284 | { |
1285 | int result = 0; |
1286 | |
1287 | pr_devel(" -> %s:%d: bus_%u\n" , __func__, __LINE__, repo->bus_index); |
1288 | |
1289 | for (repo->dev_index = 0; repo->dev_index < num_dev; |
1290 | repo->dev_index++) { |
1291 | |
1292 | result = ps3_repository_read_dev_type(repo->bus_index, |
1293 | repo->dev_index, &repo->dev_type); |
1294 | |
1295 | if (result) { |
1296 | pr_devel("%s:%d ps3_repository_read_dev_type" |
1297 | " (%u:%u) failed\n" , __func__, __LINE__, |
1298 | repo->bus_index, repo->dev_index); |
1299 | break; |
1300 | } |
1301 | |
1302 | result = ps3_repository_read_dev_id(repo->bus_index, |
1303 | repo->dev_index, &repo->dev_id); |
1304 | |
1305 | if (result) { |
1306 | pr_devel("%s:%d ps3_repository_read_dev_id" |
1307 | " (%u:%u) failed\n" , __func__, __LINE__, |
1308 | repo->bus_index, repo->dev_index); |
1309 | continue; |
1310 | } |
1311 | |
1312 | pr_devel("%s:%d (%u:%u): dev_type %u, dev_id %lu\n" , __func__, |
1313 | __LINE__, repo->bus_index, repo->dev_index, |
1314 | repo->dev_type, (unsigned long)repo->dev_id); |
1315 | |
1316 | ps3_repository_dump_resource_info(repo); |
1317 | |
1318 | if (repo->bus_type == PS3_BUS_TYPE_STORAGE) |
1319 | dump_stor_dev_info(repo); |
1320 | } |
1321 | |
1322 | pr_devel(" <- %s:%d\n" , __func__, __LINE__); |
1323 | return result; |
1324 | } |
1325 | |
1326 | int __init ps3_repository_dump_bus_info(void) |
1327 | { |
1328 | int result = 0; |
1329 | struct ps3_repository_device repo; |
1330 | |
1331 | pr_devel(" -> %s:%d\n" , __func__, __LINE__); |
1332 | |
1333 | memset(&repo, 0, sizeof(repo)); |
1334 | |
1335 | for (repo.bus_index = 0; repo.bus_index < 10; repo.bus_index++) { |
1336 | unsigned int num_dev; |
1337 | |
1338 | result = ps3_repository_read_bus_type(repo.bus_index, |
1339 | &repo.bus_type); |
1340 | |
1341 | if (result) { |
1342 | pr_devel("%s:%d read_bus_type(%u) failed\n" , |
1343 | __func__, __LINE__, repo.bus_index); |
1344 | break; |
1345 | } |
1346 | |
1347 | result = ps3_repository_read_bus_id(repo.bus_index, |
1348 | &repo.bus_id); |
1349 | |
1350 | if (result) { |
1351 | pr_devel("%s:%d read_bus_id(%u) failed\n" , |
1352 | __func__, __LINE__, repo.bus_index); |
1353 | continue; |
1354 | } |
1355 | |
1356 | if (repo.bus_index != repo.bus_id) |
1357 | pr_devel("%s:%d bus_index != bus_id\n" , |
1358 | __func__, __LINE__); |
1359 | |
1360 | result = ps3_repository_read_bus_num_dev(repo.bus_index, |
1361 | &num_dev); |
1362 | |
1363 | if (result) { |
1364 | pr_devel("%s:%d read_bus_num_dev(%u) failed\n" , |
1365 | __func__, __LINE__, repo.bus_index); |
1366 | continue; |
1367 | } |
1368 | |
1369 | pr_devel("%s:%d bus_%u: bus_type %u, bus_id %lu, num_dev %u\n" , |
1370 | __func__, __LINE__, repo.bus_index, repo.bus_type, |
1371 | (unsigned long)repo.bus_id, num_dev); |
1372 | |
1373 | dump_device_info(&repo, num_dev); |
1374 | } |
1375 | |
1376 | pr_devel(" <- %s:%d\n" , __func__, __LINE__); |
1377 | return result; |
1378 | } |
1379 | |
1380 | #endif /* defined(DEBUG) */ |
1381 | |