Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / arch / powerpc / platforms / ps3 / repository.c
1 /*
2  *  PS3 repository routines.
3  *
4  *  Copyright (C) 2006 Sony Computer Entertainment Inc.
5  *  Copyright 2006 Sony Corp.
6  *
7  *  This program is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License as published by
9  *  the Free Software Foundation; version 2 of the License.
10  *
11  *  This program is distributed in the hope that it will be useful,
12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  *  GNU General Public License for more details.
15  *
16  *  You should have received a copy of the GNU General Public License
17  *  along with this program; if not, write to the Free Software
18  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
19  */
20
21 #include <asm/lv1call.h>
22
23 #include "platform.h"
24
25 enum ps3_vendor_id {
26         PS3_VENDOR_ID_NONE = 0,
27         PS3_VENDOR_ID_SONY = 0x8000000000000000UL,
28 };
29
30 enum 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__)
36 static 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__)
53 static 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__)
65 static 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  * make_first_field - Make the first field of a repository node name.
79  * @text: Text portion of the field.
80  * @index: Numeric index portion of the field.  Use zero for 'don't care'.
81  *
82  * This routine sets the vendor id to zero (non-vendor specific).
83  * Returns field value.
84  */
85
86 static 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  * make_field - Make subsequent fields of a repository node name.
96  * @text: Text portion of the field.  Use "" for 'don't care'.
97  * @index: Numeric index portion of the field.  Use zero for 'don't care'.
98  *
99  * Returns field value.
100  */
101
102 static 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  * read_node - Read a repository node from raw fields.
112  * @n1: First field of node name.
113  * @n2: Second field of node name.  Use zero for 'don't care'.
114  * @n3: Third field of node name.  Use zero for 'don't care'.
115  * @n4: Fourth field of node name.  Use zero for 'don't care'.
116  * @v1: First repository value (high word).
117  * @v2: Second repository value (low word).  Optional parameter, use zero
118  *      for 'don't care'.
119  */
120
121 static 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
161 int 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
171 int 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
183 int 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
198 int 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
213 int 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
224 int 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
238 int 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
254 int 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
273 int 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
290 int 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
301 int 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
314 int 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
363 int 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
391 found_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
425 found_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
440 int 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
482 int 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
506 int 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
544 int 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
584 int 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
594 int 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
604 int 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
614 int 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
629 int 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
646 int 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
657 int 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
668 int 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
693 int 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  * ps3_repository_read_num_pu - Number of logical PU processors for this lpar.
716  */
717
718 int 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  * ps3_repository_read_pu_id - Read the logical PU id.
730  * @pu_index: Zero based index.
731  * @pu_id: The logical PU id.
732  */
733
734 int 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
743 int 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
753 int 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  * ps3_repository_read_mm_info - Read mm info for single pu system.
764  * @rm_base: Real mode memory base address.
765  * @rm_size: Real mode memory size.
766  * @region_total: Maximum memory region size.
767  */
768
769 int 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  * ps3_repository_read_highmem_region_count - Read the number of highmem regions
783  *
784  * Bootloaders must arrange the repository nodes such that regions are indexed
785  * with a region_index from 0 to region_count-1.
786  */
787
788 int 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
804 int 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
815 int 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  * ps3_repository_read_highmem_info - Read high memory region info
828  * @region_index: Region index, {0,..,region_count-1}.
829  * @highmem_base: High memory base address.
830  * @highmem_size: High memory size.
831  *
832  * Bootloaders that preallocate highmem regions must place the
833  * region info into the repository at these well known nodes.
834  */
835
836 int 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  * ps3_repository_read_num_spu_reserved - Number of physical spus reserved.
849  * @num_spu: Number of physical spus.
850  */
851
852 int 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  * ps3_repository_read_num_spu_resource_id - Number of spu resource reservations.
868  * @num_resource_id: Number of spu resource ids.
869  */
870
871 int 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  * ps3_repository_read_spu_resource_id - spu resource reservation id value.
887  * @res_index: Resource reservation index.
888  * @resource_type: Resource reservation type.
889  * @resource_id: Resource reservation id.
890  */
891
892 int 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
910 static 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
920 int 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
935 int 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
950 int 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   * ps3_repository_read_boot_dat_info - Get address and size of cell_ext_os_area.
967   * address: lpar address of cell_ext_os_area
968   * @size: size of cell_ext_os_area
969   */
970
971 int 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  * ps3_repository_read_num_be - Number of physical BE processors in the system.
983  */
984
985 int 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  * ps3_repository_read_be_node_id - Read the physical BE processor node id.
1002  * @be_index: Zero based index.
1003  * @node_id: The BE processor node id.
1004  */
1005
1006 int 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  * ps3_repository_read_be_id - Read the physical BE processor id.
1018  * @node_id: The BE processor node id.
1019  * @be_id: The BE processor id.
1020  */
1021
1022 int 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
1032 int 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
1042 int 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
1053 int 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
1073 static 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
1090 static 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
1107 static 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
1127 int 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
1141 int 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
1152 int 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
1163 int 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
1173 static 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
1182 static 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
1191 int 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 /* defined(CONFIG_PS3_WRITE_REPOSITORY) */
1202
1203 #if defined(DEBUG)
1204
1205 int 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, &reg_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
1258 static 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, &region_id,
1287                         &region_start, &region_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
1301 out:
1302         pr_devel(" <- %s:%d\n", __func__, __LINE__);
1303         return result;
1304 }
1305
1306 static 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
1350 int 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 /* defined(DEBUG) */