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