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: stable/10/sys/boot/powerpc/ps3/ps3repo.c 224106 2011-07-16 19:01:09Z nwhitehorn $
26 */
27
28 #include <stand.h>
29
30 #include "lv1call.h"
31 #include "ps3.h"
32 #include "ps3repo.h"
33
make_n1(const char * text,unsigned int index)34 static 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
make_n(const char * text,unsigned int index)45 static 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
ps3repo_read_bus_type(unsigned int bus_index,uint64_t * bus_type)56 int 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
ps3repo_read_bus_id(unsigned int bus_index,uint64_t * bus_id)69 int 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
ps3repo_read_bus_num_dev(unsigned int bus_index,uint64_t * num_dev)82 int 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
ps3repo_read_bus_dev_type(unsigned int bus_index,unsigned int dev_index,uint64_t * dev_type)95 int 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
ps3repo_read_bus_dev_id(unsigned int bus_index,unsigned int dev_index,uint64_t * dev_id)108 int 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
ps3repo_read_bus_dev_blk_size(unsigned int bus_index,unsigned int dev_index,uint64_t * blk_size)121 int 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
ps3repo_read_bus_dev_nblocks(unsigned int bus_index,unsigned int dev_index,uint64_t * nblocks)134 int 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
ps3repo_read_bus_dev_nregs(unsigned int bus_index,unsigned int dev_index,uint64_t * nregs)147 int 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
ps3repo_read_bus_dev_reg_id(unsigned int bus_index,unsigned int dev_index,unsigned int reg_index,uint64_t * reg_id)160 int 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
ps3repo_read_bus_dev_reg_start(unsigned int bus_index,unsigned int dev_index,unsigned int reg_index,uint64_t * reg_start)174 int 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
ps3repo_read_bus_dev_reg_size(unsigned int bus_index,unsigned int dev_index,unsigned int reg_index,uint64_t * reg_size)188 int 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
ps3repo_find_bus_by_type(uint64_t bus_type,unsigned int * bus_index)202 int 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
ps3repo_find_bus_dev_by_type(unsigned int bus_index,uint64_t dev_type,unsigned int * dev_index)226 int 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