1
2
3
4
5
6
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("n1: ", n1, func, line);
46 _dump_field("n2: ", n2, func, line);
47 _dump_field("n3: ", n3, func, line);
48 _dump_field("n4: ", 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("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 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
67
68
69
70
71
72
73
74static u64 make_first_field(const char *text, u64 index)
75{
76 u64 n;
77
78 strncpy((char *)&n, text, 8);
79 return PS3_VENDOR_ID_NONE + (n >> 32) + index;
80}
81
82
83
84
85
86
87
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
100
101
102
103
104
105
106
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(PS3_LPAR_ID_PME,
153 make_first_field("bus", bus_index),
154 make_field(bus_str, 0),
155 0, 0,
156 value, NULL);
157}
158
159int ps3_repository_read_bus_id(unsigned int bus_index, u64 *bus_id)
160{
161 return read_node(PS3_LPAR_ID_PME, make_first_field("bus", bus_index),
162 make_field("id", 0), 0, 0, 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(PS3_LPAR_ID_PME,
172 make_first_field("bus", bus_index),
173 make_field("type", 0),
174 0, 0,
175 &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(PS3_LPAR_ID_PME,
187 make_first_field("bus", bus_index),
188 make_field("num_dev", 0),
189 0, 0,
190 &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(PS3_LPAR_ID_PME,
199 make_first_field("bus", bus_index),
200 make_field("dev", dev_index),
201 make_field(dev_str, 0),
202 0,
203 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(PS3_LPAR_ID_PME, make_first_field("bus", bus_index),
210 make_field("dev", dev_index), make_field("id", 0), 0,
211 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(PS3_LPAR_ID_PME,
221 make_first_field("bus", bus_index),
222 make_field("dev", dev_index),
223 make_field("type", 0),
224 0,
225 &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(PS3_LPAR_ID_PME,
239 make_first_field("bus", bus_index),
240 make_field("dev", dev_index),
241 make_field("intr", intr_index),
242 0,
243 &v1, &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(PS3_LPAR_ID_PME,
257 make_first_field("bus", bus_index),
258 make_field("dev", dev_index),
259 make_field("reg", reg_index),
260 make_field("type", 0),
261 &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(PS3_LPAR_ID_PME,
270 make_first_field("bus", bus_index),
271 make_field("dev", dev_index),
272 make_field("reg", reg_index),
273 make_field("data", 0),
274 bus_addr, 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(tmp.bus_index, &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(tmp.bus_index, tmp.dev_index,
316 &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(tmp.bus_index, tmp.dev_index,
324 &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(tmp.bus_index,
351 &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(tmp.bus_index, &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(tmp.bus_index, &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(tmp.bus_index,
384 tmp.dev_index,
385 &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(tmp.bus_index, tmp.dev_index,
403 &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 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(repo.bus_type, 0, &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(repo.bus_index, &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);
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 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(i, &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(repo->bus_index,
497 repo->dev_index, res_index, &t, &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(repo->bus_index,
536 repo->dev_index, res_index, &t, &a, &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(PS3_LPAR_ID_PME,
564 make_first_field("bus", bus_index),
565 make_field("dev", dev_index),
566 make_field("port", 0),
567 0, 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(PS3_LPAR_ID_PME,
574 make_first_field("bus", bus_index),
575 make_field("dev", dev_index),
576 make_field("blk_size", 0),
577 0, 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(PS3_LPAR_ID_PME,
584 make_first_field("bus", bus_index),
585 make_field("dev", dev_index),
586 make_field("n_blocks", 0),
587 0, 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(PS3_LPAR_ID_PME,
597 make_first_field("bus", bus_index),
598 make_field("dev", dev_index),
599 make_field("n_regs", 0),
600 0, &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(PS3_LPAR_ID_PME,
613 make_first_field("bus", bus_index),
614 make_field("dev", dev_index),
615 make_field("region", region_index),
616 make_field("id", 0),
617 &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(PS3_LPAR_ID_PME,
626 make_first_field("bus", bus_index),
627 make_field("dev", dev_index),
628 make_field("region", region_index),
629 make_field("size", 0),
630 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(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("start", 0),
641 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
692
693
694int ps3_repository_read_num_pu(u64 *num_pu)
695{
696 *num_pu = 0;
697 return read_node(PS3_LPAR_ID_CURRENT,
698 make_first_field("bi", 0),
699 make_field("pun", 0),
700 0, 0,
701 num_pu, NULL);
702}
703
704
705
706
707
708
709
710int ps3_repository_read_pu_id(unsigned int pu_index, u64 *pu_id)
711{
712 return read_node(PS3_LPAR_ID_CURRENT,
713 make_first_field("bi", 0),
714 make_field("pu", pu_index),
715 0, 0,
716 pu_id, NULL);
717}
718
719int ps3_repository_read_rm_size(unsigned int ppe_id, u64 *rm_size)
720{
721 return read_node(PS3_LPAR_ID_CURRENT,
722 make_first_field("bi", 0),
723 make_field("pu", 0),
724 ppe_id,
725 make_field("rm_size", 0),
726 rm_size, NULL);
727}
728
729int ps3_repository_read_region_total(u64 *region_total)
730{
731 return read_node(PS3_LPAR_ID_CURRENT,
732 make_first_field("bi", 0),
733 make_field("rgntotal", 0),
734 0, 0,
735 region_total, NULL);
736}
737
738
739
740
741
742
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
759
760
761
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(PS3_LPAR_ID_CURRENT,
770 make_first_field("highmem", 0),
771 make_field("region", 0),
772 make_field("count", 0),
773 0,
774 &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(PS3_LPAR_ID_CURRENT,
784 make_first_field("highmem", 0),
785 make_field("region", region_index),
786 make_field("base", 0),
787 0,
788 highmem_base, NULL);
789}
790
791int ps3_repository_read_highmem_size(unsigned int region_index,
792 u64 *highmem_size)
793{
794 return read_node(PS3_LPAR_ID_CURRENT,
795 make_first_field("highmem", 0),
796 make_field("region", region_index),
797 make_field("size", 0),
798 0,
799 highmem_size, NULL);
800}
801
802
803
804
805
806
807
808
809
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
825
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(PS3_LPAR_ID_CURRENT,
834 make_first_field("bi", 0),
835 make_field("spun", 0),
836 0, 0,
837 &v1, NULL);
838 *num_spu_reserved = v1;
839 return result;
840}
841
842
843
844
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(PS3_LPAR_ID_CURRENT,
853 make_first_field("bi", 0),
854 make_field("spursvn", 0),
855 0, 0,
856 &v1, NULL);
857 *num_resource_id = v1;
858 return result;
859}
860
861
862
863
864
865
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(PS3_LPAR_ID_CURRENT,
876 make_first_field("bi", 0),
877 make_field("spursv", 0),
878 res_index,
879 0,
880 &v1, &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(PS3_LPAR_ID_CURRENT,
889 make_first_field("bi", 0),
890 make_field("boot_dat", 0),
891 make_field("address", 0),
892 0,
893 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(PS3_LPAR_ID_CURRENT,
902 make_first_field("bi", 0),
903 make_field("boot_dat", 0),
904 make_field("size", 0),
905 0,
906 &v1, NULL);
907 *size = v1;
908 return result;
909}
910
911int ps3_repository_read_vuart_av_port(unsigned int *port)
912{
913 int result;
914 u64 v1 = 0;
915
916 result = read_node(PS3_LPAR_ID_CURRENT,
917 make_first_field("bi", 0),
918 make_field("vir_uart", 0),
919 make_field("port", 0),
920 make_field("avset", 0),
921 &v1, NULL);
922 *port = v1;
923 return result;
924}
925
926int ps3_repository_read_vuart_sysmgr_port(unsigned int *port)
927{
928 int result;
929 u64 v1 = 0;
930
931 result = read_node(PS3_LPAR_ID_CURRENT,
932 make_first_field("bi", 0),
933 make_field("vir_uart", 0),
934 make_field("port", 0),
935 make_field("sysmgr", 0),
936 &v1, NULL);
937 *port = v1;
938 return result;
939}
940
941
942
943
944
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(lpar_addr);
953 return result ? result
954 : ps3_repository_read_boot_dat_size(size);
955}
956
957
958
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(PS3_LPAR_ID_PME,
967 make_first_field("ben", 0),
968 0,
969 0,
970 0,
971 &v1, NULL);
972 *num_be = v1;
973 return result;
974}
975
976
977
978
979
980
981
982int ps3_repository_read_be_node_id(unsigned int be_index, u64 *node_id)
983{
984 return read_node(PS3_LPAR_ID_PME,
985 make_first_field("be", be_index),
986 0,
987 0,
988 0,
989 node_id, NULL);
990}
991
992
993
994
995
996
997
998int ps3_repository_read_be_id(u64 node_id, u64 *be_id)
999{
1000 return read_node(PS3_LPAR_ID_PME,
1001 make_first_field("be", 0),
1002 node_id,
1003 0,
1004 0,
1005 be_id, NULL);
1006}
1007
1008int ps3_repository_read_tb_freq(u64 node_id, u64 *tb_freq)
1009{
1010 return read_node(PS3_LPAR_ID_PME,
1011 make_first_field("be", 0),
1012 node_id,
1013 make_field("clock", 0),
1014 0,
1015 tb_freq, NULL);
1016}
1017
1018int 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);
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);
1038 return result ? result
1039 : read_node(PS3_LPAR_ID_PME,
1040 make_first_field("be", 0),
1041 node_id,
1042 make_field("lpm", 0),
1043 make_field("priv", 0),
1044 lpar, 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
1178
1179#if defined(DEBUG)
1180
1181int 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
1234static int 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
1277out:
1278 pr_devel(" <- %s:%d\n", __func__, __LINE__);
1279 return result;
1280}
1281
1282static int 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 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
1381