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
13enum ps3_vendor_id {
14 PS3_VENDOR_ID_NONE = 0,
15 PS3_VENDOR_ID_SONY = 0x8000000000000000UL,
16};
17
18enum 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__)
24static 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__)
41static 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__)
53static 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
74static 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
90static 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
109static 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
149int 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
159int 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
165int 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
180int 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
195int 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
206int 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
214int 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
230int 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
249int 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
266int 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
277int 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
290int 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
339int 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
367found_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
401found_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
416int __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
458int __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
482int 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
520int 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
560int 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
570int 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
580int 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
590int 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
605int 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
622int 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
633int 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
644int 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
669int 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
694int 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
710int 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
719int 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
729int 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
745int 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
764int 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
780int 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
791int 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
812int 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
828int 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
847int 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
868int 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
886static 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
896int 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
911int __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
926int __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
947int 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
961int 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
982int 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
998int 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
1008int __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
1018int __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
1029int 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
1049static 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
1066static 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
1083static 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
1103int 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
1117int 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
1128int 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
1139int 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
1149static 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
1158static 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
1167int 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
1181int __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, &reg_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
1234static 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, &region_id,
1263 &region_start, &region_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
1277out:
1278 pr_devel(" <- %s:%d\n", __func__, __LINE__);
1279 return result;
1280}
1281
1282static 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
1326int __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

source code of linux/arch/powerpc/platforms/ps3/repository.c