blob: 79dfa19613dcd6b34969f8be02762efabb884dcf [file] [log] [blame]
Geoff Levand6e74b382006-11-23 00:46:55 +01001/*
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
Geoff Levand6e74b382006-11-23 00:46:55 +010021#include <asm/lv1call.h>
22
Geoff Levand2a08ea62007-01-30 15:20:27 -080023#include "platform.h"
24
Geoff Levand6e74b382006-11-23 00:46:55 +010025enum 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_debug("%s:%d: %s%016lx : %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_debug("%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_debug("%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_debug("%s:%d: v1: %016lx\n", func, line, v1);
74 pr_debug("%s:%d: v2: %016lx\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
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 * 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
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 * 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
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_get_repository_node_value(lpar_id, n1, n2, n3, n4, &v1,
135 &v2);
136
137 if (result) {
138 pr_debug("%s:%d: lv1_get_repository_node_value failed: %s\n",
139 __func__, __LINE__, ps3_result(result));
140 dump_node_name(lpar_id, n1, n2, n3, n4);
Geoff Levanda3323d12007-06-16 07:55:58 +1000141 return -ENOENT;
Geoff Levand6e74b382006-11-23 00:46:55 +0100142 }
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_debug("%s:%d: warning: discarding non-zero v1: %016lx\n",
153 __func__, __LINE__, v1);
154 if (v2 && !_v2)
155 pr_debug("%s:%d: warning: discarding non-zero v2: %016lx\n",
156 __func__, __LINE__, v2);
157
Geoff Levanda3323d12007-06-16 07:55:58 +1000158 return 0;
Geoff Levand6e74b382006-11-23 00:46:55 +0100159}
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, 0);
169}
170
Geert Uytterhoeven034e0ab2008-01-19 07:30:09 +1100171int ps3_repository_read_bus_id(unsigned int bus_index, u64 *bus_id)
Geoff Levand6e74b382006-11-23 00:46:55 +0100172{
173 int result;
Geoff Levand6e74b382006-11-23 00:46:55 +0100174
175 result = read_node(PS3_LPAR_ID_PME,
176 make_first_field("bus", bus_index),
177 make_field("id", 0),
178 0, 0,
Geert Uytterhoeven034e0ab2008-01-19 07:30:09 +1100179 bus_id, NULL);
Geoff Levand6e74b382006-11-23 00:46:55 +0100180 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;
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, 0);
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;
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, 0);
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, 0);
222}
223
224int ps3_repository_read_dev_id(unsigned int bus_index, unsigned int dev_index,
Geert Uytterhoeven034e0ab2008-01-19 07:30:09 +1100225 u64 *dev_id)
Geoff Levand6e74b382006-11-23 00:46:55 +0100226{
227 int result;
Geoff Levand6e74b382006-11-23 00:46:55 +0100228
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,
Geert Uytterhoeven034e0ab2008-01-19 07:30:09 +1100234 dev_id, 0);
Geoff Levand6e74b382006-11-23 00:46:55 +0100235 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;
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, 0);
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,
Geoff Levandeebb81c2007-01-26 19:07:47 -0800256 enum ps3_interrupt_type *intr_type, unsigned int* interrupt_id)
Geoff Levand6e74b382006-11-23 00:46:55 +0100257{
258 int result;
259 u64 v1;
260 u64 v2;
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,
Geoff Levandeebb81c2007-01-26 19:07:47 -0800274 unsigned int dev_index, unsigned int reg_index,
275 enum ps3_reg_type *reg_type)
Geoff Levand6e74b382006-11-23 00:46:55 +0100276{
277 int result;
278 u64 v1;
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, 0);
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,
Geoff Levandeebb81c2007-01-26 19:07:47 -0800302 unsigned int dev_index, unsigned int reg_index,
303 enum ps3_reg_type *reg_type, u64 *bus_addr, u64 *len)
Geoff Levand6e74b382006-11-23 00:46:55 +0100304{
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
Geoff Levanda3323d12007-06-16 07:55:58 +1000312
313
314int ps3_repository_find_device(struct ps3_repository_device *repo)
Geoff Levand6e74b382006-11-23 00:46:55 +0100315{
Geoff Levanda3323d12007-06-16 07:55:58 +1000316 int result;
317 struct ps3_repository_device tmp = *repo;
318 unsigned int num_dev;
Geoff Levand6e74b382006-11-23 00:46:55 +0100319
Geoff Levanda3323d12007-06-16 07:55:58 +1000320 BUG_ON(repo->bus_index > 10);
321 BUG_ON(repo->dev_index > 10);
Geoff Levand6e74b382006-11-23 00:46:55 +0100322
Geoff Levanda3323d12007-06-16 07:55:58 +1000323 result = ps3_repository_read_bus_num_dev(tmp.bus_index, &num_dev);
Geoff Levand6e74b382006-11-23 00:46:55 +0100324
Geert Uytterhoeven6c7be7d2007-01-26 19:07:51 -0800325 if (result) {
Geoff Levanda3323d12007-06-16 07:55:58 +1000326 pr_debug("%s:%d read_bus_num_dev failed\n", __func__, __LINE__);
327 return result;
Geert Uytterhoeven6c7be7d2007-01-26 19:07:51 -0800328 }
329
Geert Uytterhoeven034e0ab2008-01-19 07:30:09 +1100330 pr_debug("%s:%d: bus_type %u, bus_index %u, bus_id %lu, num_dev %u\n",
Geoff Levanda3323d12007-06-16 07:55:58 +1000331 __func__, __LINE__, tmp.bus_type, tmp.bus_index, tmp.bus_id,
332 num_dev);
Geert Uytterhoeven6c7be7d2007-01-26 19:07:51 -0800333
Geoff Levanda3323d12007-06-16 07:55:58 +1000334 if (tmp.dev_index >= num_dev) {
335 pr_debug("%s:%d: no device found\n", __func__, __LINE__);
336 return -ENODEV;
Geert Uytterhoeven6c7be7d2007-01-26 19:07:51 -0800337 }
338
Geoff Levanda3323d12007-06-16 07:55:58 +1000339 result = ps3_repository_read_dev_type(tmp.bus_index, tmp.dev_index,
340 &tmp.dev_type);
341
342 if (result) {
343 pr_debug("%s:%d read_dev_type failed\n", __func__, __LINE__);
344 return result;
345 }
346
Geert Uytterhoevend51dd3d2007-09-06 18:14:57 +0200347 if (tmp.bus_type == PS3_BUS_TYPE_STORAGE) {
348 /*
349 * A storage device may show up in the repository before the
350 * hypervisor has finished probing its type and regions
351 */
352 unsigned int num_regions;
353
354 if (tmp.dev_type == PS3_DEV_TYPE_STOR_DUMMY) {
355 pr_debug("%s:%u storage device not ready\n", __func__,
356 __LINE__);
357 return -ENODEV;
358 }
359
360 result = ps3_repository_read_stor_dev_num_regions(tmp.bus_index,
361 tmp.dev_index,
362 &num_regions);
363 if (result) {
364 pr_debug("%s:%d read_stor_dev_num_regions failed\n",
365 __func__, __LINE__);
366 return result;
367 }
368
369 if (!num_regions) {
370 pr_debug("%s:%u storage device has no regions yet\n",
371 __func__, __LINE__);
372 return -ENODEV;
373 }
374 }
375
Geoff Levanda3323d12007-06-16 07:55:58 +1000376 result = ps3_repository_read_dev_id(tmp.bus_index, tmp.dev_index,
377 &tmp.dev_id);
378
379 if (result) {
380 pr_debug("%s:%d ps3_repository_read_dev_id failed\n", __func__,
381 __LINE__);
382 return result;
383 }
384
Geert Uytterhoeven034e0ab2008-01-19 07:30:09 +1100385 pr_debug("%s:%d: found: dev_type %u, dev_index %u, dev_id %lu\n",
Geoff Levanda3323d12007-06-16 07:55:58 +1000386 __func__, __LINE__, tmp.dev_type, tmp.dev_index, tmp.dev_id);
387
388 *repo = tmp;
389 return 0;
Geert Uytterhoeven6c7be7d2007-01-26 19:07:51 -0800390}
391
Geert Uytterhoevene06bcf32008-01-19 07:30:27 +1100392int ps3_repository_find_device_by_id(struct ps3_repository_device *repo,
393 u64 bus_id, u64 dev_id)
394{
395 int result = -ENODEV;
396 struct ps3_repository_device tmp;
397 unsigned int num_dev;
398
399 pr_debug(" -> %s:%u: find device by id %lu:%lu\n", __func__, __LINE__,
400 bus_id, dev_id);
401
402 for (tmp.bus_index = 0; tmp.bus_index < 10; tmp.bus_index++) {
403 result = ps3_repository_read_bus_id(tmp.bus_index,
404 &tmp.bus_id);
405 if (result) {
406 pr_debug("%s:%u read_bus_id(%u) failed\n", __func__,
407 __LINE__, tmp.bus_index);
408 return result;
409 }
410
411 if (tmp.bus_id == bus_id)
412 goto found_bus;
413
414 pr_debug("%s:%u: skip, bus_id %lu\n", __func__, __LINE__,
415 tmp.bus_id);
416 }
417 pr_debug(" <- %s:%u: bus not found\n", __func__, __LINE__);
418 return result;
419
420found_bus:
421 result = ps3_repository_read_bus_type(tmp.bus_index, &tmp.bus_type);
422 if (result) {
423 pr_debug("%s:%u read_bus_type(%u) failed\n", __func__,
424 __LINE__, tmp.bus_index);
425 return result;
426 }
427
428 result = ps3_repository_read_bus_num_dev(tmp.bus_index, &num_dev);
429 if (result) {
430 pr_debug("%s:%u read_bus_num_dev failed\n", __func__,
431 __LINE__);
432 return result;
433 }
434
435 for (tmp.dev_index = 0; tmp.dev_index < num_dev; tmp.dev_index++) {
436 result = ps3_repository_read_dev_id(tmp.bus_index,
437 tmp.dev_index,
438 &tmp.dev_id);
439 if (result) {
440 pr_debug("%s:%u read_dev_id(%u:%u) failed\n", __func__,
441 __LINE__, tmp.bus_index, tmp.dev_index);
442 return result;
443 }
444
445 if (tmp.dev_id == dev_id)
446 goto found_dev;
447
448 pr_debug("%s:%u: skip, dev_id %lu\n", __func__, __LINE__,
449 tmp.dev_id);
450 }
451 pr_debug(" <- %s:%u: dev not found\n", __func__, __LINE__);
452 return result;
453
454found_dev:
455 result = ps3_repository_read_dev_type(tmp.bus_index, tmp.dev_index,
456 &tmp.dev_type);
457 if (result) {
458 pr_debug("%s:%u read_dev_type failed\n", __func__, __LINE__);
459 return result;
460 }
461
462 pr_debug(" <- %s:%u: found: type (%u:%u) index (%u:%u) id (%lu:%lu)\n",
463 __func__, __LINE__, tmp.bus_type, tmp.dev_type, tmp.bus_index,
464 tmp.dev_index, tmp.bus_id, tmp.dev_id);
465 *repo = tmp;
466 return 0;
467}
468
Geoff Levanda3323d12007-06-16 07:55:58 +1000469int __devinit ps3_repository_find_devices(enum ps3_bus_type bus_type,
470 int (*callback)(const struct ps3_repository_device *repo))
Geoff Levand6e74b382006-11-23 00:46:55 +0100471{
472 int result = 0;
Geoff Levanda3323d12007-06-16 07:55:58 +1000473 struct ps3_repository_device repo;
Geoff Levand6e74b382006-11-23 00:46:55 +0100474
Geoff Levanda3323d12007-06-16 07:55:58 +1000475 pr_debug(" -> %s:%d: find bus_type %u\n", __func__, __LINE__, bus_type);
Geoff Levand6e74b382006-11-23 00:46:55 +0100476
Geoff Levanda3323d12007-06-16 07:55:58 +1000477 for (repo.bus_index = 0; repo.bus_index < 10; repo.bus_index++) {
Geoff Levand6e74b382006-11-23 00:46:55 +0100478
Geoff Levanda3323d12007-06-16 07:55:58 +1000479 result = ps3_repository_read_bus_type(repo.bus_index,
480 &repo.bus_type);
Geoff Levand6e74b382006-11-23 00:46:55 +0100481
482 if (result) {
483 pr_debug("%s:%d read_bus_type(%u) failed\n",
Geoff Levanda3323d12007-06-16 07:55:58 +1000484 __func__, __LINE__, repo.bus_index);
Geoff Levand6e74b382006-11-23 00:46:55 +0100485 break;
486 }
487
Geoff Levanda3323d12007-06-16 07:55:58 +1000488 if (repo.bus_type != bus_type) {
489 pr_debug("%s:%d: skip, bus_type %u\n", __func__,
490 __LINE__, repo.bus_type);
491 continue;
492 }
493
494 result = ps3_repository_read_bus_id(repo.bus_index,
495 &repo.bus_id);
Geoff Levand6e74b382006-11-23 00:46:55 +0100496
497 if (result) {
498 pr_debug("%s:%d read_bus_id(%u) failed\n",
Geoff Levanda3323d12007-06-16 07:55:58 +1000499 __func__, __LINE__, repo.bus_index);
Geoff Levand6e74b382006-11-23 00:46:55 +0100500 continue;
501 }
502
Geoff Levanda3323d12007-06-16 07:55:58 +1000503 for (repo.dev_index = 0; ; repo.dev_index++) {
504 result = ps3_repository_find_device(&repo);
Geoff Levand6e74b382006-11-23 00:46:55 +0100505
Geoff Levanda3323d12007-06-16 07:55:58 +1000506 if (result == -ENODEV) {
507 result = 0;
508 break;
509 } else if (result)
510 break;
Geoff Levand6e74b382006-11-23 00:46:55 +0100511
Geoff Levanda3323d12007-06-16 07:55:58 +1000512 result = callback(&repo);
513
514 if (result) {
515 pr_debug("%s:%d: abort at callback\n", __func__,
516 __LINE__);
517 break;
518 }
Geoff Levand6e74b382006-11-23 00:46:55 +0100519 }
Geoff Levanda3323d12007-06-16 07:55:58 +1000520 break;
Geoff Levand6e74b382006-11-23 00:46:55 +0100521 }
522
523 pr_debug(" <- %s:%d\n", __func__, __LINE__);
524 return result;
525}
Geoff Levand6e74b382006-11-23 00:46:55 +0100526
Geoff Levanda3323d12007-06-16 07:55:58 +1000527int ps3_repository_find_bus(enum ps3_bus_type bus_type, unsigned int from,
528 unsigned int *bus_index)
Geoff Levand6e74b382006-11-23 00:46:55 +0100529{
Geoff Levanda3323d12007-06-16 07:55:58 +1000530 unsigned int i;
531 enum ps3_bus_type type;
532 int error;
Geoff Levand6e74b382006-11-23 00:46:55 +0100533
Geoff Levanda3323d12007-06-16 07:55:58 +1000534 for (i = from; i < 10; i++) {
535 error = ps3_repository_read_bus_type(i, &type);
536 if (error) {
Geoff Levand6e74b382006-11-23 00:46:55 +0100537 pr_debug("%s:%d read_bus_type failed\n",
538 __func__, __LINE__);
Geoff Levanda3323d12007-06-16 07:55:58 +1000539 *bus_index = UINT_MAX;
540 return error;
Geoff Levand6e74b382006-11-23 00:46:55 +0100541 }
Geoff Levanda3323d12007-06-16 07:55:58 +1000542 if (type == bus_type) {
543 *bus_index = i;
544 return 0;
545 }
Geoff Levand6e74b382006-11-23 00:46:55 +0100546 }
Geoff Levanda3323d12007-06-16 07:55:58 +1000547 *bus_index = UINT_MAX;
548 return -ENODEV;
Geoff Levand6e74b382006-11-23 00:46:55 +0100549}
550
Geoff Levanda3323d12007-06-16 07:55:58 +1000551int ps3_repository_find_interrupt(const struct ps3_repository_device *repo,
Geoff Levand6e74b382006-11-23 00:46:55 +0100552 enum ps3_interrupt_type intr_type, unsigned int *interrupt_id)
553{
554 int result = 0;
555 unsigned int res_index;
556
557 pr_debug("%s:%d: find intr_type %u\n", __func__, __LINE__, intr_type);
558
559 *interrupt_id = UINT_MAX;
560
561 for (res_index = 0; res_index < 10; res_index++) {
562 enum ps3_interrupt_type t;
563 unsigned int id;
564
Geoff Levanda3323d12007-06-16 07:55:58 +1000565 result = ps3_repository_read_dev_intr(repo->bus_index,
566 repo->dev_index, res_index, &t, &id);
Geoff Levand6e74b382006-11-23 00:46:55 +0100567
568 if (result) {
569 pr_debug("%s:%d read_dev_intr failed\n",
570 __func__, __LINE__);
571 return result;
572 }
573
574 if (t == intr_type) {
575 *interrupt_id = id;
576 break;
577 }
578 }
579
Geoff Levandeebb81c2007-01-26 19:07:47 -0800580 if (res_index == 10)
581 return -ENODEV;
Geoff Levand6e74b382006-11-23 00:46:55 +0100582
583 pr_debug("%s:%d: found intr_type %u at res_index %u\n",
584 __func__, __LINE__, intr_type, res_index);
585
586 return result;
587}
588
Geoff Levanda3323d12007-06-16 07:55:58 +1000589int ps3_repository_find_reg(const struct ps3_repository_device *repo,
Geoff Levandeebb81c2007-01-26 19:07:47 -0800590 enum ps3_reg_type reg_type, u64 *bus_addr, u64 *len)
Geoff Levand6e74b382006-11-23 00:46:55 +0100591{
592 int result = 0;
593 unsigned int res_index;
594
595 pr_debug("%s:%d: find reg_type %u\n", __func__, __LINE__, reg_type);
596
597 *bus_addr = *len = 0;
598
599 for (res_index = 0; res_index < 10; res_index++) {
Geoff Levandeebb81c2007-01-26 19:07:47 -0800600 enum ps3_reg_type t;
Geoff Levand6e74b382006-11-23 00:46:55 +0100601 u64 a;
602 u64 l;
603
Geoff Levanda3323d12007-06-16 07:55:58 +1000604 result = ps3_repository_read_dev_reg(repo->bus_index,
605 repo->dev_index, res_index, &t, &a, &l);
Geoff Levand6e74b382006-11-23 00:46:55 +0100606
607 if (result) {
608 pr_debug("%s:%d read_dev_reg failed\n",
609 __func__, __LINE__);
610 return result;
611 }
612
613 if (t == reg_type) {
614 *bus_addr = a;
615 *len = l;
616 break;
617 }
618 }
619
Geoff Levandeebb81c2007-01-26 19:07:47 -0800620 if (res_index == 10)
621 return -ENODEV;
Geoff Levand6e74b382006-11-23 00:46:55 +0100622
623 pr_debug("%s:%d: found reg_type %u at res_index %u\n",
624 __func__, __LINE__, reg_type, res_index);
625
626 return result;
627}
628
Geert Uytterhoeven6c7be7d2007-01-26 19:07:51 -0800629int ps3_repository_read_stor_dev_port(unsigned int bus_index,
630 unsigned int dev_index, u64 *port)
631{
632 return read_node(PS3_LPAR_ID_PME,
633 make_first_field("bus", bus_index),
634 make_field("dev", dev_index),
635 make_field("port", 0),
636 0, port, 0);
637}
638
639int ps3_repository_read_stor_dev_blk_size(unsigned int bus_index,
640 unsigned int dev_index, u64 *blk_size)
641{
642 return read_node(PS3_LPAR_ID_PME,
643 make_first_field("bus", bus_index),
644 make_field("dev", dev_index),
645 make_field("blk_size", 0),
646 0, blk_size, 0);
647}
648
649int ps3_repository_read_stor_dev_num_blocks(unsigned int bus_index,
650 unsigned int dev_index, u64 *num_blocks)
651{
652 return read_node(PS3_LPAR_ID_PME,
653 make_first_field("bus", bus_index),
654 make_field("dev", dev_index),
655 make_field("n_blocks", 0),
656 0, num_blocks, 0);
657}
658
659int ps3_repository_read_stor_dev_num_regions(unsigned int bus_index,
660 unsigned int dev_index, unsigned int *num_regions)
661{
662 int result;
663 u64 v1;
664
665 result = read_node(PS3_LPAR_ID_PME,
666 make_first_field("bus", bus_index),
667 make_field("dev", dev_index),
668 make_field("n_regs", 0),
669 0, &v1, 0);
670 *num_regions = v1;
671 return result;
672}
673
674int ps3_repository_read_stor_dev_region_id(unsigned int bus_index,
675 unsigned int dev_index, unsigned int region_index,
676 unsigned int *region_id)
677{
678 int result;
679 u64 v1;
680
681 result = read_node(PS3_LPAR_ID_PME,
682 make_first_field("bus", bus_index),
683 make_field("dev", dev_index),
684 make_field("region", region_index),
685 make_field("id", 0),
686 &v1, 0);
687 *region_id = v1;
688 return result;
689}
690
691int ps3_repository_read_stor_dev_region_size(unsigned int bus_index,
692 unsigned int dev_index, unsigned int region_index, u64 *region_size)
693{
694 return read_node(PS3_LPAR_ID_PME,
695 make_first_field("bus", bus_index),
696 make_field("dev", dev_index),
697 make_field("region", region_index),
698 make_field("size", 0),
699 region_size, 0);
700}
701
702int ps3_repository_read_stor_dev_region_start(unsigned int bus_index,
703 unsigned int dev_index, unsigned int region_index, u64 *region_start)
704{
705 return read_node(PS3_LPAR_ID_PME,
706 make_first_field("bus", bus_index),
707 make_field("dev", dev_index),
708 make_field("region", region_index),
709 make_field("start", 0),
710 region_start, 0);
711}
712
713int ps3_repository_read_stor_dev_info(unsigned int bus_index,
714 unsigned int dev_index, u64 *port, u64 *blk_size,
715 u64 *num_blocks, unsigned int *num_regions)
716{
717 int result;
718
719 result = ps3_repository_read_stor_dev_port(bus_index, dev_index, port);
720 if (result)
721 return result;
722
723 result = ps3_repository_read_stor_dev_blk_size(bus_index, dev_index,
724 blk_size);
725 if (result)
726 return result;
727
728 result = ps3_repository_read_stor_dev_num_blocks(bus_index, dev_index,
729 num_blocks);
730 if (result)
731 return result;
732
733 result = ps3_repository_read_stor_dev_num_regions(bus_index, dev_index,
734 num_regions);
735 return result;
736}
737
738int ps3_repository_read_stor_dev_region(unsigned int bus_index,
739 unsigned int dev_index, unsigned int region_index,
740 unsigned int *region_id, u64 *region_start, u64 *region_size)
741{
742 int result;
743
744 result = ps3_repository_read_stor_dev_region_id(bus_index, dev_index,
745 region_index, region_id);
746 if (result)
747 return result;
748
749 result = ps3_repository_read_stor_dev_region_start(bus_index, dev_index,
750 region_index, region_start);
751 if (result)
752 return result;
753
754 result = ps3_repository_read_stor_dev_region_size(bus_index, dev_index,
755 region_index, region_size);
756 return result;
757}
758
Geoff Levand6e74b382006-11-23 00:46:55 +0100759int ps3_repository_read_rm_size(unsigned int ppe_id, u64 *rm_size)
760{
761 return read_node(PS3_LPAR_ID_CURRENT,
762 make_first_field("bi", 0),
763 make_field("pu", 0),
764 ppe_id,
765 make_field("rm_size", 0),
766 rm_size, 0);
767}
768
769int ps3_repository_read_region_total(u64 *region_total)
770{
771 return read_node(PS3_LPAR_ID_CURRENT,
772 make_first_field("bi", 0),
773 make_field("rgntotal", 0),
774 0, 0,
775 region_total, 0);
776}
777
778/**
779 * ps3_repository_read_mm_info - Read mm info for single pu system.
780 * @rm_base: Real mode memory base address.
781 * @rm_size: Real mode memory size.
782 * @region_total: Maximum memory region size.
783 */
784
785int ps3_repository_read_mm_info(u64 *rm_base, u64 *rm_size, u64 *region_total)
786{
787 int result;
788 u64 ppe_id;
789
790 lv1_get_logical_ppe_id(&ppe_id);
791 *rm_base = 0;
792 result = ps3_repository_read_rm_size(ppe_id, rm_size);
793 return result ? result
794 : ps3_repository_read_region_total(region_total);
795}
796
797/**
798 * ps3_repository_read_num_spu_reserved - Number of physical spus reserved.
799 * @num_spu: Number of physical spus.
800 */
801
802int ps3_repository_read_num_spu_reserved(unsigned int *num_spu_reserved)
803{
804 int result;
805 u64 v1;
806
807 result = read_node(PS3_LPAR_ID_CURRENT,
808 make_first_field("bi", 0),
809 make_field("spun", 0),
810 0, 0,
811 &v1, 0);
812 *num_spu_reserved = v1;
813 return result;
814}
815
816/**
817 * ps3_repository_read_num_spu_resource_id - Number of spu resource reservations.
818 * @num_resource_id: Number of spu resource ids.
819 */
820
821int ps3_repository_read_num_spu_resource_id(unsigned int *num_resource_id)
822{
823 int result;
824 u64 v1;
825
826 result = read_node(PS3_LPAR_ID_CURRENT,
827 make_first_field("bi", 0),
828 make_field("spursvn", 0),
829 0, 0,
830 &v1, 0);
831 *num_resource_id = v1;
832 return result;
833}
834
835/**
836 * ps3_repository_read_spu_resource_id - spu resource reservation id value.
837 * @res_index: Resource reservation index.
838 * @resource_type: Resource reservation type.
839 * @resource_id: Resource reservation id.
840 */
841
842int ps3_repository_read_spu_resource_id(unsigned int res_index,
843 enum ps3_spu_resource_type* resource_type, unsigned int *resource_id)
844{
845 int result;
846 u64 v1;
847 u64 v2;
848
849 result = read_node(PS3_LPAR_ID_CURRENT,
850 make_first_field("bi", 0),
851 make_field("spursv", 0),
852 res_index,
853 0,
854 &v1, &v2);
855 *resource_type = v1;
856 *resource_id = v2;
857 return result;
858}
859
860int ps3_repository_read_boot_dat_address(u64 *address)
861{
862 return read_node(PS3_LPAR_ID_CURRENT,
863 make_first_field("bi", 0),
864 make_field("boot_dat", 0),
865 make_field("address", 0),
866 0,
867 address, 0);
868}
869
870int ps3_repository_read_boot_dat_size(unsigned int *size)
871{
872 int result;
873 u64 v1;
874
875 result = read_node(PS3_LPAR_ID_CURRENT,
876 make_first_field("bi", 0),
877 make_field("boot_dat", 0),
878 make_field("size", 0),
879 0,
880 &v1, 0);
881 *size = v1;
882 return result;
883}
884
Geoff Levanda3323d12007-06-16 07:55:58 +1000885int ps3_repository_read_vuart_av_port(unsigned int *port)
886{
887 int result;
888 u64 v1;
889
890 result = read_node(PS3_LPAR_ID_CURRENT,
891 make_first_field("bi", 0),
892 make_field("vir_uart", 0),
893 make_field("port", 0),
894 make_field("avset", 0),
895 &v1, 0);
896 *port = v1;
897 return result;
898}
899
900int ps3_repository_read_vuart_sysmgr_port(unsigned int *port)
901{
902 int result;
903 u64 v1;
904
905 result = read_node(PS3_LPAR_ID_CURRENT,
906 make_first_field("bi", 0),
907 make_field("vir_uart", 0),
908 make_field("port", 0),
909 make_field("sysmgr", 0),
910 &v1, 0);
911 *port = v1;
912 return result;
913}
914
Geoff Levand6e74b382006-11-23 00:46:55 +0100915/**
916 * ps3_repository_read_boot_dat_info - Get address and size of cell_ext_os_area.
917 * address: lpar address of cell_ext_os_area
918 * @size: size of cell_ext_os_area
919 */
920
921int ps3_repository_read_boot_dat_info(u64 *lpar_addr, unsigned int *size)
922{
923 int result;
924
925 *size = 0;
926 result = ps3_repository_read_boot_dat_address(lpar_addr);
927 return result ? result
928 : ps3_repository_read_boot_dat_size(size);
929}
930
931int ps3_repository_read_num_be(unsigned int *num_be)
932{
933 int result;
934 u64 v1;
935
936 result = read_node(PS3_LPAR_ID_PME,
937 make_first_field("ben", 0),
938 0,
939 0,
940 0,
941 &v1, 0);
942 *num_be = v1;
943 return result;
944}
945
946int ps3_repository_read_be_node_id(unsigned int be_index, u64 *node_id)
947{
948 return read_node(PS3_LPAR_ID_PME,
949 make_first_field("be", be_index),
950 0,
951 0,
952 0,
953 node_id, 0);
954}
955
956int ps3_repository_read_tb_freq(u64 node_id, u64 *tb_freq)
957{
958 return read_node(PS3_LPAR_ID_PME,
959 make_first_field("be", 0),
960 node_id,
961 make_field("clock", 0),
962 0,
963 tb_freq, 0);
964}
965
966int ps3_repository_read_be_tb_freq(unsigned int be_index, u64 *tb_freq)
967{
968 int result;
969 u64 node_id;
970
971 *tb_freq = 0;
972 result = ps3_repository_read_be_node_id(0, &node_id);
973 return result ? result
974 : ps3_repository_read_tb_freq(node_id, tb_freq);
975}
Geoff Levanda3323d12007-06-16 07:55:58 +1000976
977#if defined(DEBUG)
978
979int ps3_repository_dump_resource_info(const struct ps3_repository_device *repo)
980{
981 int result = 0;
982 unsigned int res_index;
983
984 pr_debug(" -> %s:%d: (%u:%u)\n", __func__, __LINE__,
985 repo->bus_index, repo->dev_index);
986
987 for (res_index = 0; res_index < 10; res_index++) {
988 enum ps3_interrupt_type intr_type;
989 unsigned int interrupt_id;
990
991 result = ps3_repository_read_dev_intr(repo->bus_index,
992 repo->dev_index, res_index, &intr_type, &interrupt_id);
993
994 if (result) {
995 if (result != LV1_NO_ENTRY)
996 pr_debug("%s:%d ps3_repository_read_dev_intr"
997 " (%u:%u) failed\n", __func__, __LINE__,
998 repo->bus_index, repo->dev_index);
999 break;
1000 }
1001
1002 pr_debug("%s:%d (%u:%u) intr_type %u, interrupt_id %u\n",
1003 __func__, __LINE__, repo->bus_index, repo->dev_index,
1004 intr_type, interrupt_id);
1005 }
1006
1007 for (res_index = 0; res_index < 10; res_index++) {
1008 enum ps3_reg_type reg_type;
1009 u64 bus_addr;
1010 u64 len;
1011
1012 result = ps3_repository_read_dev_reg(repo->bus_index,
1013 repo->dev_index, res_index, &reg_type, &bus_addr, &len);
1014
1015 if (result) {
1016 if (result != LV1_NO_ENTRY)
1017 pr_debug("%s:%d ps3_repository_read_dev_reg"
1018 " (%u:%u) failed\n", __func__, __LINE__,
1019 repo->bus_index, repo->dev_index);
1020 break;
1021 }
1022
1023 pr_debug("%s:%d (%u:%u) reg_type %u, bus_addr %lxh, len %lxh\n",
1024 __func__, __LINE__, repo->bus_index, repo->dev_index,
1025 reg_type, bus_addr, len);
1026 }
1027
1028 pr_debug(" <- %s:%d\n", __func__, __LINE__);
1029 return result;
1030}
1031
1032static int dump_stor_dev_info(struct ps3_repository_device *repo)
1033{
1034 int result = 0;
1035 unsigned int num_regions, region_index;
1036 u64 port, blk_size, num_blocks;
1037
1038 pr_debug(" -> %s:%d: (%u:%u)\n", __func__, __LINE__,
1039 repo->bus_index, repo->dev_index);
1040
1041 result = ps3_repository_read_stor_dev_info(repo->bus_index,
1042 repo->dev_index, &port, &blk_size, &num_blocks, &num_regions);
1043 if (result) {
1044 pr_debug("%s:%d ps3_repository_read_stor_dev_info"
1045 " (%u:%u) failed\n", __func__, __LINE__,
1046 repo->bus_index, repo->dev_index);
1047 goto out;
1048 }
1049
1050 pr_debug("%s:%d (%u:%u): port %lu, blk_size %lu, num_blocks "
1051 "%lu, num_regions %u\n",
1052 __func__, __LINE__, repo->bus_index, repo->dev_index, port,
1053 blk_size, num_blocks, num_regions);
1054
1055 for (region_index = 0; region_index < num_regions; region_index++) {
1056 unsigned int region_id;
1057 u64 region_start, region_size;
1058
1059 result = ps3_repository_read_stor_dev_region(repo->bus_index,
1060 repo->dev_index, region_index, &region_id,
1061 &region_start, &region_size);
1062 if (result) {
1063 pr_debug("%s:%d ps3_repository_read_stor_dev_region"
1064 " (%u:%u) failed\n", __func__, __LINE__,
1065 repo->bus_index, repo->dev_index);
1066 break;
1067 }
1068
1069 pr_debug("%s:%d (%u:%u) region_id %u, start %lxh, size %lxh\n",
1070 __func__, __LINE__, repo->bus_index, repo->dev_index,
1071 region_id, region_start, region_size);
1072 }
1073
1074out:
1075 pr_debug(" <- %s:%d\n", __func__, __LINE__);
1076 return result;
1077}
1078
1079static int dump_device_info(struct ps3_repository_device *repo,
1080 unsigned int num_dev)
1081{
1082 int result = 0;
1083
1084 pr_debug(" -> %s:%d: bus_%u\n", __func__, __LINE__, repo->bus_index);
1085
1086 for (repo->dev_index = 0; repo->dev_index < num_dev;
1087 repo->dev_index++) {
1088
1089 result = ps3_repository_read_dev_type(repo->bus_index,
1090 repo->dev_index, &repo->dev_type);
1091
1092 if (result) {
1093 pr_debug("%s:%d ps3_repository_read_dev_type"
1094 " (%u:%u) failed\n", __func__, __LINE__,
1095 repo->bus_index, repo->dev_index);
1096 break;
1097 }
1098
1099 result = ps3_repository_read_dev_id(repo->bus_index,
1100 repo->dev_index, &repo->dev_id);
1101
1102 if (result) {
1103 pr_debug("%s:%d ps3_repository_read_dev_id"
1104 " (%u:%u) failed\n", __func__, __LINE__,
1105 repo->bus_index, repo->dev_index);
1106 continue;
1107 }
1108
Geert Uytterhoeven034e0ab2008-01-19 07:30:09 +11001109 pr_debug("%s:%d (%u:%u): dev_type %u, dev_id %lu\n", __func__,
Geoff Levanda3323d12007-06-16 07:55:58 +10001110 __LINE__, repo->bus_index, repo->dev_index,
1111 repo->dev_type, repo->dev_id);
1112
1113 ps3_repository_dump_resource_info(repo);
1114
1115 if (repo->bus_type == PS3_BUS_TYPE_STORAGE)
1116 dump_stor_dev_info(repo);
1117 }
1118
1119 pr_debug(" <- %s:%d\n", __func__, __LINE__);
1120 return result;
1121}
1122
1123int ps3_repository_dump_bus_info(void)
1124{
1125 int result = 0;
1126 struct ps3_repository_device repo;
1127
1128 pr_debug(" -> %s:%d\n", __func__, __LINE__);
1129
1130 memset(&repo, 0, sizeof(repo));
1131
1132 for (repo.bus_index = 0; repo.bus_index < 10; repo.bus_index++) {
1133 unsigned int num_dev;
1134
1135 result = ps3_repository_read_bus_type(repo.bus_index,
1136 &repo.bus_type);
1137
1138 if (result) {
1139 pr_debug("%s:%d read_bus_type(%u) failed\n",
1140 __func__, __LINE__, repo.bus_index);
1141 break;
1142 }
1143
1144 result = ps3_repository_read_bus_id(repo.bus_index,
1145 &repo.bus_id);
1146
1147 if (result) {
1148 pr_debug("%s:%d read_bus_id(%u) failed\n",
1149 __func__, __LINE__, repo.bus_index);
1150 continue;
1151 }
1152
1153 if (repo.bus_index != repo.bus_id)
1154 pr_debug("%s:%d bus_index != bus_id\n",
1155 __func__, __LINE__);
1156
1157 result = ps3_repository_read_bus_num_dev(repo.bus_index,
1158 &num_dev);
1159
1160 if (result) {
1161 pr_debug("%s:%d read_bus_num_dev(%u) failed\n",
1162 __func__, __LINE__, repo.bus_index);
1163 continue;
1164 }
1165
Geert Uytterhoeven034e0ab2008-01-19 07:30:09 +11001166 pr_debug("%s:%d bus_%u: bus_type %u, bus_id %lu, num_dev %u\n",
Geoff Levanda3323d12007-06-16 07:55:58 +10001167 __func__, __LINE__, repo.bus_index, repo.bus_type,
1168 repo.bus_id, num_dev);
1169
1170 dump_device_info(&repo, num_dev);
1171 }
1172
1173 pr_debug(" <- %s:%d\n", __func__, __LINE__);
1174 return result;
1175}
1176
1177#endif /* defined(DEBUG) */