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