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 24int 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 35static int (*cfe_dispfunc) (intptr_t handle, intptr_t xiocb); 36static u64 cfe_handle; 37 38int cfe_init(u64 handle, u64 ept) 39{ 40 cfe_dispfunc = NATIVE_FROM_XPTR(ept); 41 cfe_handle = handle; 42 return 0; 43} 44 45int 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 52int 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 68int 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 89int 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 106int 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 126int 127cfe_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 150int 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 166int 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 181int 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 201int 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 223int 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 247 return 0; 248} 249 250int cfe_getstdhandle(int flg) 251{ 252 struct cfe_xiocb xiocb; 253 254 xiocb.xiocb_fcode = CFE_CMD_DEV_GETHANDLE; 255 xiocb.xiocb_status = 0; 256 xiocb.xiocb_handle = 0; 257 xiocb.xiocb_flags = flg; 258 xiocb.xiocb_psize = 0; 259 260 cfe_iocb_dispatch(&xiocb); 261 262 if (xiocb.xiocb_status < 0) 263 return xiocb.xiocb_status; 264 return xiocb.xiocb_handle; 265} 266 267int64_t 268cfe_getticks(void) 269{ 270 struct cfe_xiocb xiocb; 271 272 xiocb.xiocb_fcode = CFE_CMD_FW_GETTIME; 273 xiocb.xiocb_status = 0; 274 xiocb.xiocb_handle = 0; 275 xiocb.xiocb_flags = 0; 276 xiocb.xiocb_psize = sizeof(struct xiocb_time); 277 xiocb.plist.xiocb_time.ticks = 0; 278 279 cfe_iocb_dispatch(&xiocb); 280 281 return xiocb.plist.xiocb_time.ticks; 282 283} 284 285int cfe_inpstat(int handle) 286{ 287 struct cfe_xiocb xiocb; 288 289 xiocb.xiocb_fcode = CFE_CMD_DEV_INPSTAT; 290 xiocb.xiocb_status = 0; 291 xiocb.xiocb_handle = handle; 292 xiocb.xiocb_flags = 0; 293 xiocb.xiocb_psize = sizeof(struct xiocb_inpstat); 294 xiocb.plist.xiocb_inpstat.inp_status = 0; 295 296 cfe_iocb_dispatch(&xiocb); 297 298 if (xiocb.xiocb_status < 0) 299 return xiocb.xiocb_status; 300 return xiocb.plist.xiocb_inpstat.inp_status; 301} 302 303int 304cfe_ioctl(int handle, unsigned int ioctlnum, unsigned char *buffer, 305 int length, int *retlen, u64 offset) 306{ 307 struct cfe_xiocb xiocb; 308 309 xiocb.xiocb_fcode = CFE_CMD_DEV_IOCTL; 310 xiocb.xiocb_status = 0; 311 xiocb.xiocb_handle = handle; 312 xiocb.xiocb_flags = 0; 313 xiocb.xiocb_psize = sizeof(struct xiocb_buffer); 314 xiocb.plist.xiocb_buffer.buf_offset = offset; 315 xiocb.plist.xiocb_buffer.buf_ioctlcmd = ioctlnum; 316 xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer); 317 xiocb.plist.xiocb_buffer.buf_length = length; 318 319 cfe_iocb_dispatch(&xiocb); 320 321 if (retlen) 322 *retlen = xiocb.plist.xiocb_buffer.buf_retlen; 323 return xiocb.xiocb_status; 324} 325 326int cfe_open(char *name) 327{ 328 struct cfe_xiocb xiocb; 329 330 xiocb.xiocb_fcode = CFE_CMD_DEV_OPEN; 331 xiocb.xiocb_status = 0; 332 xiocb.xiocb_handle = 0; 333 xiocb.xiocb_flags = 0; 334 xiocb.xiocb_psize = sizeof(struct xiocb_buffer); 335 xiocb.plist.xiocb_buffer.buf_offset = 0; 336 xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(name); 337 xiocb.plist.xiocb_buffer.buf_length = strlen(name); 338 339 cfe_iocb_dispatch(&xiocb); 340 341 if (xiocb.xiocb_status < 0) 342 return xiocb.xiocb_status; 343 return xiocb.xiocb_handle; 344} 345 346int cfe_read(int handle, unsigned char *buffer, int length) 347{ 348 return cfe_readblk(handle, 0, buffer, length); 349} 350 351int cfe_readblk(int handle, s64 offset, unsigned char *buffer, int length) 352{ 353 struct cfe_xiocb xiocb; 354 355 xiocb.xiocb_fcode = CFE_CMD_DEV_READ; 356 xiocb.xiocb_status = 0; 357 xiocb.xiocb_handle = handle; 358 xiocb.xiocb_flags = 0; 359 xiocb.xiocb_psize = sizeof(struct xiocb_buffer); 360 xiocb.plist.xiocb_buffer.buf_offset = offset; 361 xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer); 362 xiocb.plist.xiocb_buffer.buf_length = length; 363 364 cfe_iocb_dispatch(&xiocb); 365 366 if (xiocb.xiocb_status < 0) 367 return xiocb.xiocb_status; 368 return xiocb.plist.xiocb_buffer.buf_retlen; 369} 370 371int cfe_setenv(char *name, char *val) 372{ 373 struct cfe_xiocb xiocb; 374 375 xiocb.xiocb_fcode = CFE_CMD_ENV_SET; 376 xiocb.xiocb_status = 0; 377 xiocb.xiocb_handle = 0; 378 xiocb.xiocb_flags = 0; 379 xiocb.xiocb_psize = sizeof(struct xiocb_envbuf); 380 xiocb.plist.xiocb_envbuf.enum_idx = 0; 381 xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name); 382 xiocb.plist.xiocb_envbuf.name_length = strlen(name); 383 xiocb.plist.xiocb_envbuf.val_ptr = XPTR_FROM_NATIVE(val); 384 xiocb.plist.xiocb_envbuf.val_length = strlen(val); 385 386 cfe_iocb_dispatch(&xiocb); 387 388 return xiocb.xiocb_status; 389} 390 391int cfe_write(int handle, const char *buffer, int length) 392{ 393 return cfe_writeblk(handle, 0, buffer, length); 394} 395 396int cfe_writeblk(int handle, s64 offset, const char *buffer, int length) 397{ 398 struct cfe_xiocb xiocb; 399 400 xiocb.xiocb_fcode = CFE_CMD_DEV_WRITE; 401 xiocb.xiocb_status = 0; 402 xiocb.xiocb_handle = handle; 403 xiocb.xiocb_flags = 0; 404 xiocb.xiocb_psize = sizeof(struct xiocb_buffer); 405 xiocb.plist.xiocb_buffer.buf_offset = offset; 406 xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer); 407 xiocb.plist.xiocb_buffer.buf_length = length; 408 409 cfe_iocb_dispatch(&xiocb); 410 411 if (xiocb.xiocb_status < 0) 412 return xiocb.xiocb_status; 413 return xiocb.plist.xiocb_buffer.buf_retlen; 414} 415