1/*- 2 * Copyright (C) 2011 glevand (geoffrey.levand@mail.ru) 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 16 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 17 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 18 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 19 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 20 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 21 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 22 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 23 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 24 * 25 * $FreeBSD$ 26 */ 27 28#include <stand.h> 29 30#include "lv1call.h" 31#include "ps3.h" 32#include "ps3repo.h" 33 34static uint64_t make_n1(const char *text, unsigned int index) 35{ 36 uint64_t n1; 37 38 n1 = 0; 39 strncpy((char *) &n1, text, sizeof(n1)); 40 n1 = (n1 >> 32) + index; 41 42 return n1; 43} 44 45static uint64_t make_n(const char *text, unsigned int index) 46{ 47 uint64_t n; 48 49 n = 0; 50 strncpy((char *) &n, text, sizeof(n)); 51 n = n + index; 52 53 return n; 54} 55 56int ps3repo_read_bus_type(unsigned int bus_index, uint64_t *bus_type) 57{ 58 uint64_t v1, v2; 59 int err; 60 61 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 62 make_n("type", 0), 0, 0, &v1, &v2); 63 64 *bus_type = v1; 65 66 return err; 67} 68 69int ps3repo_read_bus_id(unsigned int bus_index, uint64_t *bus_id) 70{ 71 uint64_t v1, v2; 72 int err; 73 74 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 75 make_n("id", 0), 0, 0, &v1, &v2); 76 77 *bus_id = v1; 78 79 return err; 80} 81 82int ps3repo_read_bus_num_dev(unsigned int bus_index, uint64_t *num_dev) 83{ 84 uint64_t v1, v2; 85 int err; 86 87 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 88 make_n("num_dev", 0), 0, 0, &v1, &v2); 89 90 *num_dev = v1; 91 92 return err; 93} 94 95int ps3repo_read_bus_dev_type(unsigned int bus_index, unsigned int dev_index, uint64_t *dev_type) 96{ 97 uint64_t v1, v2; 98 int err; 99 100 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 101 make_n("dev", dev_index), make_n("type", 0), 0, &v1, &v2); 102 103 *dev_type = v1; 104 105 return err; 106} 107 108int ps3repo_read_bus_dev_id(unsigned int bus_index, unsigned int dev_index, uint64_t *dev_id) 109{ 110 uint64_t v1, v2; 111 int err; 112 113 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 114 make_n("dev", dev_index), make_n("id", 0), 0, &v1, &v2); 115 116 *dev_id = v1; 117 118 return err; 119} 120 121int ps3repo_read_bus_dev_blk_size(unsigned int bus_index, unsigned int dev_index, uint64_t *blk_size) 122{ 123 uint64_t v1, v2; 124 int err; 125 126 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 127 make_n("dev", dev_index), make_n("blk_size", 0), 0, &v1, &v2); 128 129 *blk_size = v1; 130 131 return err; 132} 133 134int ps3repo_read_bus_dev_nblocks(unsigned int bus_index, unsigned int dev_index, uint64_t *nblocks) 135{ 136 uint64_t v1, v2; 137 int err; 138 139 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 140 make_n("dev", dev_index), make_n("n_blocks", 0), 0, &v1, &v2); 141 142 *nblocks = v1; 143 144 return err; 145} 146 147int ps3repo_read_bus_dev_nregs(unsigned int bus_index, unsigned int dev_index, uint64_t *nregs) 148{ 149 uint64_t v1, v2; 150 int err; 151 152 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 153 make_n("dev", dev_index), make_n("n_regs", 0), 0, &v1, &v2); 154 155 *nregs = v1; 156 157 return err; 158} 159 160int ps3repo_read_bus_dev_reg_id(unsigned int bus_index, unsigned int dev_index, 161 unsigned int reg_index, uint64_t *reg_id) 162{ 163 uint64_t v1, v2; 164 int err; 165 166 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 167 make_n("dev", dev_index), make_n("region", reg_index), make_n("id", 0), &v1, &v2); 168 169 *reg_id = v1; 170 171 return err; 172} 173 174int ps3repo_read_bus_dev_reg_start(unsigned int bus_index, unsigned int dev_index, 175 unsigned int reg_index, uint64_t *reg_start) 176{ 177 uint64_t v1, v2; 178 int err; 179 180 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 181 make_n("dev", dev_index), make_n("region", reg_index), make_n("start", 0), &v1, &v2); 182 183 *reg_start = v1; 184 185 return err; 186} 187 188int ps3repo_read_bus_dev_reg_size(unsigned int bus_index, unsigned int dev_index, 189 unsigned int reg_index, uint64_t *reg_size) 190{ 191 uint64_t v1, v2; 192 int err; 193 194 err = lv1_get_repository_node_value(PS3_LPAR_ID_PME, make_n1("bus", bus_index), 195 make_n("dev", dev_index), make_n("region", reg_index), make_n("size", 0), &v1, &v2); 196 197 *reg_size = v1; 198 199 return err; 200} 201 202int ps3repo_find_bus_by_type(uint64_t bus_type, unsigned int *bus_index) 203{ 204 unsigned int i; 205 uint64_t type; 206 int err; 207 208 for (i = 0; i < 10; i++) { 209 err = ps3repo_read_bus_type(i, &type); 210 if (err) { 211 *bus_index = (unsigned int) -1; 212 return err; 213 } 214 215 if (type == bus_type) { 216 *bus_index = i; 217 return 0; 218 } 219 } 220 221 *bus_index = (unsigned int) -1; 222 223 return ENODEV; 224} 225 226int ps3repo_find_bus_dev_by_type(unsigned int bus_index, uint64_t dev_type, 227 unsigned int *dev_index) 228{ 229 unsigned int i; 230 uint64_t type; 231 int err; 232 233 for (i = 0; i < 10; i++) { 234 err = ps3repo_read_bus_dev_type(bus_index, i, &type); 235 if (err) { 236 *dev_index = (unsigned int) -1; 237 return err; 238 } 239 240 if (type == dev_type) { 241 *dev_index = i; 242 return 0; 243 } 244 } 245 246 *dev_index = (unsigned int) -1; 247 248 return ENODEV; 249} 250