Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * Copyright (C) 2000, 2001, 2002 Broadcom Corporation | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or | |
5 | * modify it under the terms of the GNU General Public License | |
6 | * as published by the Free Software Foundation; either version 2 | |
7 | * of the License, or (at your option) any later version. | |
8 | * | |
9 | * This program is distributed in the hope that it will be useful, | |
10 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
11 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
12 | * GNU General Public License for more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License | |
15 | * along with this program; if not, write to the Free Software | |
16 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
17 | */ | |
18 | ||
417345d8 CH |
19 | /* |
20 | * | |
21 | * Broadcom Common Firmware Environment (CFE) | |
22 | * | |
23 | * This module contains device function stubs (small routines to | |
24 | * call the standard "iocb" interface entry point to CFE). | |
25 | * There should be one routine here per iocb function call. | |
26 | * | |
27 | * Authors: Mitch Lichtenberg, Chris Demetriou | |
28 | */ | |
1da177e4 | 29 | |
df78b5c8 | 30 | #include <asm/fw/cfe/cfe_api.h> |
1da177e4 LT |
31 | #include "cfe_api_int.h" |
32 | ||
33 | /* Cast from a native pointer to a cfe_xptr_t and back. */ | |
34 | #define XPTR_FROM_NATIVE(n) ((cfe_xptr_t) (intptr_t) (n)) | |
35 | #define NATIVE_FROM_XPTR(x) ((void *) (intptr_t) (x)) | |
36 | ||
417345d8 | 37 | int cfe_iocb_dispatch(struct cfe_xiocb *xiocb); |
1da177e4 | 38 | |
1da177e4 LT |
39 | /* |
40 | * Declare the dispatch function with args of "intptr_t". | |
41 | * This makes sure whatever model we're compiling in | |
42 | * puts the pointers in a single register. For example, | |
43 | * combining -mlong64 and -mips1 or -mips2 would lead to | |
44 | * trouble, since the handle and IOCB pointer will be | |
45 | * passed in two registers each, and CFE expects one. | |
46 | */ | |
47 | ||
982f6ffe RB |
48 | static int (*cfe_dispfunc) (intptr_t handle, intptr_t xiocb); |
49 | static u64 cfe_handle; | |
1da177e4 | 50 | |
417345d8 | 51 | int cfe_init(u64 handle, u64 ept) |
1da177e4 LT |
52 | { |
53 | cfe_dispfunc = NATIVE_FROM_XPTR(ept); | |
54 | cfe_handle = handle; | |
55 | return 0; | |
56 | } | |
57 | ||
417345d8 | 58 | int cfe_iocb_dispatch(struct cfe_xiocb * xiocb) |
1da177e4 LT |
59 | { |
60 | if (!cfe_dispfunc) | |
61 | return -1; | |
62 | return (*cfe_dispfunc) ((intptr_t) cfe_handle, (intptr_t) xiocb); | |
63 | } | |
1da177e4 | 64 | |
1da177e4 LT |
65 | int cfe_close(int handle) |
66 | { | |
417345d8 | 67 | struct cfe_xiocb xiocb; |
1da177e4 LT |
68 | |
69 | xiocb.xiocb_fcode = CFE_CMD_DEV_CLOSE; | |
70 | xiocb.xiocb_status = 0; | |
71 | xiocb.xiocb_handle = handle; | |
72 | xiocb.xiocb_flags = 0; | |
73 | xiocb.xiocb_psize = 0; | |
74 | ||
75 | cfe_iocb_dispatch(&xiocb); | |
76 | ||
77 | return xiocb.xiocb_status; | |
78 | ||
79 | } | |
1da177e4 | 80 | |
1da177e4 LT |
81 | int cfe_cpu_start(int cpu, void (*fn) (void), long sp, long gp, long a1) |
82 | { | |
417345d8 | 83 | struct cfe_xiocb xiocb; |
1da177e4 LT |
84 | |
85 | xiocb.xiocb_fcode = CFE_CMD_FW_CPUCTL; | |
86 | xiocb.xiocb_status = 0; | |
87 | xiocb.xiocb_handle = 0; | |
88 | xiocb.xiocb_flags = 0; | |
417345d8 | 89 | xiocb.xiocb_psize = sizeof(struct xiocb_cpuctl); |
1da177e4 LT |
90 | xiocb.plist.xiocb_cpuctl.cpu_number = cpu; |
91 | xiocb.plist.xiocb_cpuctl.cpu_command = CFE_CPU_CMD_START; | |
92 | xiocb.plist.xiocb_cpuctl.gp_val = gp; | |
93 | xiocb.plist.xiocb_cpuctl.sp_val = sp; | |
94 | xiocb.plist.xiocb_cpuctl.a1_val = a1; | |
95 | xiocb.plist.xiocb_cpuctl.start_addr = (long) fn; | |
96 | ||
97 | cfe_iocb_dispatch(&xiocb); | |
98 | ||
99 | return xiocb.xiocb_status; | |
100 | } | |
1da177e4 | 101 | |
1da177e4 LT |
102 | int cfe_cpu_stop(int cpu) |
103 | { | |
417345d8 | 104 | struct cfe_xiocb xiocb; |
1da177e4 LT |
105 | |
106 | xiocb.xiocb_fcode = CFE_CMD_FW_CPUCTL; | |
107 | xiocb.xiocb_status = 0; | |
108 | xiocb.xiocb_handle = 0; | |
109 | xiocb.xiocb_flags = 0; | |
417345d8 | 110 | xiocb.xiocb_psize = sizeof(struct xiocb_cpuctl); |
1da177e4 LT |
111 | xiocb.plist.xiocb_cpuctl.cpu_number = cpu; |
112 | xiocb.plist.xiocb_cpuctl.cpu_command = CFE_CPU_CMD_STOP; | |
113 | ||
114 | cfe_iocb_dispatch(&xiocb); | |
115 | ||
116 | return xiocb.xiocb_status; | |
117 | } | |
1da177e4 | 118 | |
1da177e4 LT |
119 | int cfe_enumenv(int idx, char *name, int namelen, char *val, int vallen) |
120 | { | |
417345d8 | 121 | struct cfe_xiocb xiocb; |
1da177e4 LT |
122 | |
123 | xiocb.xiocb_fcode = CFE_CMD_ENV_SET; | |
124 | xiocb.xiocb_status = 0; | |
125 | xiocb.xiocb_handle = 0; | |
126 | xiocb.xiocb_flags = 0; | |
417345d8 | 127 | xiocb.xiocb_psize = sizeof(struct xiocb_envbuf); |
1da177e4 LT |
128 | xiocb.plist.xiocb_envbuf.enum_idx = idx; |
129 | xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name); | |
130 | xiocb.plist.xiocb_envbuf.name_length = namelen; | |
131 | xiocb.plist.xiocb_envbuf.val_ptr = XPTR_FROM_NATIVE(val); | |
132 | xiocb.plist.xiocb_envbuf.val_length = vallen; | |
133 | ||
134 | cfe_iocb_dispatch(&xiocb); | |
135 | ||
136 | return xiocb.xiocb_status; | |
137 | } | |
1da177e4 | 138 | |
1da177e4 | 139 | int |
417345d8 | 140 | cfe_enummem(int idx, int flags, u64 *start, u64 *length, u64 *type) |
1da177e4 | 141 | { |
417345d8 | 142 | struct cfe_xiocb xiocb; |
1da177e4 LT |
143 | |
144 | xiocb.xiocb_fcode = CFE_CMD_FW_MEMENUM; | |
145 | xiocb.xiocb_status = 0; | |
146 | xiocb.xiocb_handle = 0; | |
147 | xiocb.xiocb_flags = flags; | |
417345d8 | 148 | xiocb.xiocb_psize = sizeof(struct xiocb_meminfo); |
1da177e4 LT |
149 | xiocb.plist.xiocb_meminfo.mi_idx = idx; |
150 | ||
151 | cfe_iocb_dispatch(&xiocb); | |
152 | ||
153 | if (xiocb.xiocb_status < 0) | |
154 | return xiocb.xiocb_status; | |
155 | ||
156 | *start = xiocb.plist.xiocb_meminfo.mi_addr; | |
157 | *length = xiocb.plist.xiocb_meminfo.mi_size; | |
158 | *type = xiocb.plist.xiocb_meminfo.mi_type; | |
159 | ||
160 | return 0; | |
161 | } | |
1da177e4 | 162 | |
1da177e4 LT |
163 | int cfe_exit(int warm, int status) |
164 | { | |
417345d8 | 165 | struct cfe_xiocb xiocb; |
1da177e4 LT |
166 | |
167 | xiocb.xiocb_fcode = CFE_CMD_FW_RESTART; | |
168 | xiocb.xiocb_status = 0; | |
169 | xiocb.xiocb_handle = 0; | |
170 | xiocb.xiocb_flags = warm ? CFE_FLG_WARMSTART : 0; | |
417345d8 | 171 | xiocb.xiocb_psize = sizeof(struct xiocb_exitstat); |
1da177e4 LT |
172 | xiocb.plist.xiocb_exitstat.status = status; |
173 | ||
174 | cfe_iocb_dispatch(&xiocb); | |
175 | ||
176 | return xiocb.xiocb_status; | |
177 | } | |
1da177e4 | 178 | |
1da177e4 LT |
179 | int cfe_flushcache(int flg) |
180 | { | |
417345d8 | 181 | struct cfe_xiocb xiocb; |
1da177e4 LT |
182 | |
183 | xiocb.xiocb_fcode = CFE_CMD_FW_FLUSHCACHE; | |
184 | xiocb.xiocb_status = 0; | |
185 | xiocb.xiocb_handle = 0; | |
186 | xiocb.xiocb_flags = flg; | |
187 | xiocb.xiocb_psize = 0; | |
188 | ||
189 | cfe_iocb_dispatch(&xiocb); | |
190 | ||
191 | return xiocb.xiocb_status; | |
192 | } | |
1da177e4 | 193 | |
1da177e4 LT |
194 | int cfe_getdevinfo(char *name) |
195 | { | |
417345d8 | 196 | struct cfe_xiocb xiocb; |
1da177e4 LT |
197 | |
198 | xiocb.xiocb_fcode = CFE_CMD_DEV_GETINFO; | |
199 | xiocb.xiocb_status = 0; | |
200 | xiocb.xiocb_handle = 0; | |
201 | xiocb.xiocb_flags = 0; | |
417345d8 | 202 | xiocb.xiocb_psize = sizeof(struct xiocb_buffer); |
1da177e4 LT |
203 | xiocb.plist.xiocb_buffer.buf_offset = 0; |
204 | xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(name); | |
417345d8 | 205 | xiocb.plist.xiocb_buffer.buf_length = strlen(name); |
1da177e4 LT |
206 | |
207 | cfe_iocb_dispatch(&xiocb); | |
208 | ||
209 | if (xiocb.xiocb_status < 0) | |
210 | return xiocb.xiocb_status; | |
417345d8 | 211 | return xiocb.plist.xiocb_buffer.buf_ioctlcmd; |
1da177e4 | 212 | } |
1da177e4 | 213 | |
1da177e4 LT |
214 | int cfe_getenv(char *name, char *dest, int destlen) |
215 | { | |
417345d8 | 216 | struct cfe_xiocb xiocb; |
1da177e4 LT |
217 | |
218 | *dest = 0; | |
219 | ||
220 | xiocb.xiocb_fcode = CFE_CMD_ENV_GET; | |
221 | xiocb.xiocb_status = 0; | |
222 | xiocb.xiocb_handle = 0; | |
223 | xiocb.xiocb_flags = 0; | |
417345d8 | 224 | xiocb.xiocb_psize = sizeof(struct xiocb_envbuf); |
1da177e4 LT |
225 | xiocb.plist.xiocb_envbuf.enum_idx = 0; |
226 | xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name); | |
417345d8 | 227 | xiocb.plist.xiocb_envbuf.name_length = strlen(name); |
1da177e4 LT |
228 | xiocb.plist.xiocb_envbuf.val_ptr = XPTR_FROM_NATIVE(dest); |
229 | xiocb.plist.xiocb_envbuf.val_length = destlen; | |
230 | ||
231 | cfe_iocb_dispatch(&xiocb); | |
232 | ||
233 | return xiocb.xiocb_status; | |
234 | } | |
1da177e4 | 235 | |
1da177e4 LT |
236 | int cfe_getfwinfo(cfe_fwinfo_t * info) |
237 | { | |
417345d8 | 238 | struct cfe_xiocb xiocb; |
1da177e4 LT |
239 | |
240 | xiocb.xiocb_fcode = CFE_CMD_FW_GETINFO; | |
241 | xiocb.xiocb_status = 0; | |
242 | xiocb.xiocb_handle = 0; | |
243 | xiocb.xiocb_flags = 0; | |
417345d8 | 244 | xiocb.xiocb_psize = sizeof(struct xiocb_fwinfo); |
1da177e4 LT |
245 | |
246 | cfe_iocb_dispatch(&xiocb); | |
247 | ||
248 | if (xiocb.xiocb_status < 0) | |
249 | return xiocb.xiocb_status; | |
250 | ||
251 | info->fwi_version = xiocb.plist.xiocb_fwinfo.fwi_version; | |
252 | info->fwi_totalmem = xiocb.plist.xiocb_fwinfo.fwi_totalmem; | |
253 | info->fwi_flags = xiocb.plist.xiocb_fwinfo.fwi_flags; | |
254 | info->fwi_boardid = xiocb.plist.xiocb_fwinfo.fwi_boardid; | |
255 | info->fwi_bootarea_va = xiocb.plist.xiocb_fwinfo.fwi_bootarea_va; | |
256 | info->fwi_bootarea_pa = xiocb.plist.xiocb_fwinfo.fwi_bootarea_pa; | |
257 | info->fwi_bootarea_size = | |
258 | xiocb.plist.xiocb_fwinfo.fwi_bootarea_size; | |
259 | #if 0 | |
260 | info->fwi_reserved1 = xiocb.plist.xiocb_fwinfo.fwi_reserved1; | |
261 | info->fwi_reserved2 = xiocb.plist.xiocb_fwinfo.fwi_reserved2; | |
262 | info->fwi_reserved3 = xiocb.plist.xiocb_fwinfo.fwi_reserved3; | |
263 | #endif | |
264 | ||
265 | return 0; | |
266 | } | |
1da177e4 | 267 | |
1da177e4 LT |
268 | int cfe_getstdhandle(int flg) |
269 | { | |
417345d8 | 270 | struct cfe_xiocb xiocb; |
1da177e4 LT |
271 | |
272 | xiocb.xiocb_fcode = CFE_CMD_DEV_GETHANDLE; | |
273 | xiocb.xiocb_status = 0; | |
274 | xiocb.xiocb_handle = 0; | |
275 | xiocb.xiocb_flags = flg; | |
276 | xiocb.xiocb_psize = 0; | |
277 | ||
278 | cfe_iocb_dispatch(&xiocb); | |
279 | ||
280 | if (xiocb.xiocb_status < 0) | |
281 | return xiocb.xiocb_status; | |
282 | return xiocb.xiocb_handle; | |
283 | } | |
1da177e4 | 284 | |
1da177e4 | 285 | int64_t |
1da177e4 | 286 | cfe_getticks(void) |
1da177e4 | 287 | { |
417345d8 | 288 | struct cfe_xiocb xiocb; |
1da177e4 LT |
289 | |
290 | xiocb.xiocb_fcode = CFE_CMD_FW_GETTIME; | |
291 | xiocb.xiocb_status = 0; | |
292 | xiocb.xiocb_handle = 0; | |
293 | xiocb.xiocb_flags = 0; | |
417345d8 | 294 | xiocb.xiocb_psize = sizeof(struct xiocb_time); |
1da177e4 LT |
295 | xiocb.plist.xiocb_time.ticks = 0; |
296 | ||
297 | cfe_iocb_dispatch(&xiocb); | |
298 | ||
299 | return xiocb.plist.xiocb_time.ticks; | |
300 | ||
301 | } | |
1da177e4 | 302 | |
1da177e4 LT |
303 | int cfe_inpstat(int handle) |
304 | { | |
417345d8 | 305 | struct cfe_xiocb xiocb; |
1da177e4 LT |
306 | |
307 | xiocb.xiocb_fcode = CFE_CMD_DEV_INPSTAT; | |
308 | xiocb.xiocb_status = 0; | |
309 | xiocb.xiocb_handle = handle; | |
310 | xiocb.xiocb_flags = 0; | |
417345d8 | 311 | xiocb.xiocb_psize = sizeof(struct xiocb_inpstat); |
1da177e4 LT |
312 | xiocb.plist.xiocb_inpstat.inp_status = 0; |
313 | ||
314 | cfe_iocb_dispatch(&xiocb); | |
315 | ||
316 | if (xiocb.xiocb_status < 0) | |
317 | return xiocb.xiocb_status; | |
318 | return xiocb.plist.xiocb_inpstat.inp_status; | |
319 | } | |
1da177e4 | 320 | |
1da177e4 LT |
321 | int |
322 | cfe_ioctl(int handle, unsigned int ioctlnum, unsigned char *buffer, | |
417345d8 | 323 | int length, int *retlen, u64 offset) |
1da177e4 | 324 | { |
417345d8 | 325 | struct cfe_xiocb xiocb; |
1da177e4 LT |
326 | |
327 | xiocb.xiocb_fcode = CFE_CMD_DEV_IOCTL; | |
328 | xiocb.xiocb_status = 0; | |
329 | xiocb.xiocb_handle = handle; | |
330 | xiocb.xiocb_flags = 0; | |
417345d8 | 331 | xiocb.xiocb_psize = sizeof(struct xiocb_buffer); |
1da177e4 LT |
332 | xiocb.plist.xiocb_buffer.buf_offset = offset; |
333 | xiocb.plist.xiocb_buffer.buf_ioctlcmd = ioctlnum; | |
334 | xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer); | |
335 | xiocb.plist.xiocb_buffer.buf_length = length; | |
336 | ||
337 | cfe_iocb_dispatch(&xiocb); | |
338 | ||
339 | if (retlen) | |
340 | *retlen = xiocb.plist.xiocb_buffer.buf_retlen; | |
341 | return xiocb.xiocb_status; | |
342 | } | |
1da177e4 | 343 | |
1da177e4 LT |
344 | int cfe_open(char *name) |
345 | { | |
417345d8 | 346 | struct cfe_xiocb xiocb; |
1da177e4 LT |
347 | |
348 | xiocb.xiocb_fcode = CFE_CMD_DEV_OPEN; | |
349 | xiocb.xiocb_status = 0; | |
350 | xiocb.xiocb_handle = 0; | |
351 | xiocb.xiocb_flags = 0; | |
417345d8 | 352 | xiocb.xiocb_psize = sizeof(struct xiocb_buffer); |
1da177e4 LT |
353 | xiocb.plist.xiocb_buffer.buf_offset = 0; |
354 | xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(name); | |
417345d8 | 355 | xiocb.plist.xiocb_buffer.buf_length = strlen(name); |
1da177e4 LT |
356 | |
357 | cfe_iocb_dispatch(&xiocb); | |
358 | ||
359 | if (xiocb.xiocb_status < 0) | |
360 | return xiocb.xiocb_status; | |
361 | return xiocb.xiocb_handle; | |
362 | } | |
1da177e4 | 363 | |
1da177e4 LT |
364 | int cfe_read(int handle, unsigned char *buffer, int length) |
365 | { | |
366 | return cfe_readblk(handle, 0, buffer, length); | |
367 | } | |
1da177e4 | 368 | |
417345d8 | 369 | int cfe_readblk(int handle, s64 offset, unsigned char *buffer, int length) |
1da177e4 | 370 | { |
417345d8 | 371 | struct cfe_xiocb xiocb; |
1da177e4 LT |
372 | |
373 | xiocb.xiocb_fcode = CFE_CMD_DEV_READ; | |
374 | xiocb.xiocb_status = 0; | |
375 | xiocb.xiocb_handle = handle; | |
376 | xiocb.xiocb_flags = 0; | |
417345d8 | 377 | xiocb.xiocb_psize = sizeof(struct xiocb_buffer); |
1da177e4 LT |
378 | xiocb.plist.xiocb_buffer.buf_offset = offset; |
379 | xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer); | |
380 | xiocb.plist.xiocb_buffer.buf_length = length; | |
381 | ||
382 | cfe_iocb_dispatch(&xiocb); | |
383 | ||
384 | if (xiocb.xiocb_status < 0) | |
385 | return xiocb.xiocb_status; | |
386 | return xiocb.plist.xiocb_buffer.buf_retlen; | |
387 | } | |
1da177e4 | 388 | |
1da177e4 LT |
389 | int cfe_setenv(char *name, char *val) |
390 | { | |
417345d8 | 391 | struct cfe_xiocb xiocb; |
1da177e4 LT |
392 | |
393 | xiocb.xiocb_fcode = CFE_CMD_ENV_SET; | |
394 | xiocb.xiocb_status = 0; | |
395 | xiocb.xiocb_handle = 0; | |
396 | xiocb.xiocb_flags = 0; | |
417345d8 | 397 | xiocb.xiocb_psize = sizeof(struct xiocb_envbuf); |
1da177e4 LT |
398 | xiocb.plist.xiocb_envbuf.enum_idx = 0; |
399 | xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name); | |
417345d8 | 400 | xiocb.plist.xiocb_envbuf.name_length = strlen(name); |
1da177e4 | 401 | xiocb.plist.xiocb_envbuf.val_ptr = XPTR_FROM_NATIVE(val); |
417345d8 | 402 | xiocb.plist.xiocb_envbuf.val_length = strlen(val); |
1da177e4 LT |
403 | |
404 | cfe_iocb_dispatch(&xiocb); | |
405 | ||
406 | return xiocb.xiocb_status; | |
407 | } | |
1da177e4 | 408 | |
1da177e4 LT |
409 | int cfe_write(int handle, unsigned char *buffer, int length) |
410 | { | |
411 | return cfe_writeblk(handle, 0, buffer, length); | |
412 | } | |
1da177e4 | 413 | |
417345d8 | 414 | int cfe_writeblk(int handle, s64 offset, unsigned char *buffer, int length) |
1da177e4 | 415 | { |
417345d8 | 416 | struct cfe_xiocb xiocb; |
1da177e4 LT |
417 | |
418 | xiocb.xiocb_fcode = CFE_CMD_DEV_WRITE; | |
419 | xiocb.xiocb_status = 0; | |
420 | xiocb.xiocb_handle = handle; | |
421 | xiocb.xiocb_flags = 0; | |
417345d8 | 422 | xiocb.xiocb_psize = sizeof(struct xiocb_buffer); |
1da177e4 LT |
423 | xiocb.plist.xiocb_buffer.buf_offset = offset; |
424 | xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer); | |
425 | xiocb.plist.xiocb_buffer.buf_length = length; | |
426 | ||
427 | cfe_iocb_dispatch(&xiocb); | |
428 | ||
429 | if (xiocb.xiocb_status < 0) | |
430 | return xiocb.xiocb_status; | |
431 | return xiocb.plist.xiocb_buffer.buf_retlen; | |
432 | } |