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