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