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