[mirror_ubuntu-jammy-kernel.git] / arch / mips / fw / cfe / cfe_api.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Copyright (C) 2000, 2001, 2002 Broadcom Corporation
 */

/*
 *
 * Broadcom Common Firmware Environment (CFE)
 *
 * This module contains device function stubs (small routines to
 * call the standard "iocb" interface entry point to CFE).
 * There should be one routine here per iocb function call.
 *
 * Authors:  Mitch Lichtenberg, Chris Demetriou
 */

#include <asm/fw/cfe/cfe_api.h>
#include "cfe_api_int.h"

/* Cast from a native pointer to a cfe_xptr_t and back.	 */
#define XPTR_FROM_NATIVE(n)	((cfe_xptr_t) (intptr_t) (n))
#define NATIVE_FROM_XPTR(x)	((void *) (intptr_t) (x))

int cfe_iocb_dispatch(struct cfe_xiocb *xiocb);

/*
 * Declare the dispatch function with args of "intptr_t".
 * This makes sure whatever model we're compiling in
 * puts the pointers in a single register.  For example,
 * combining -mlong64 and -mips1 or -mips2 would lead to
 * trouble, since the handle and IOCB pointer will be
 * passed in two registers each, and CFE expects one.
 */

static int (*cfe_dispfunc) (intptr_t handle, intptr_t xiocb);
static u64 cfe_handle;

int cfe_init(u64 handle, u64 ept)
{
	cfe_dispfunc = NATIVE_FROM_XPTR(ept);
	cfe_handle = handle;
	return 0;
}

int cfe_iocb_dispatch(struct cfe_xiocb * xiocb)
{
	if (!cfe_dispfunc)
		return -1;
	return (*cfe_dispfunc) ((intptr_t) cfe_handle, (intptr_t) xiocb);
}

int cfe_close(int handle)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_DEV_CLOSE;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = handle;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = 0;

	cfe_iocb_dispatch(&xiocb);

	return xiocb.xiocb_status;

}

int cfe_cpu_start(int cpu, void (*fn) (void), long sp, long gp, long a1)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_FW_CPUCTL;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_cpuctl);
	xiocb.plist.xiocb_cpuctl.cpu_number = cpu;
	xiocb.plist.xiocb_cpuctl.cpu_command = CFE_CPU_CMD_START;
	xiocb.plist.xiocb_cpuctl.gp_val = gp;
	xiocb.plist.xiocb_cpuctl.sp_val = sp;
	xiocb.plist.xiocb_cpuctl.a1_val = a1;
	xiocb.plist.xiocb_cpuctl.start_addr = (long) fn;

	cfe_iocb_dispatch(&xiocb);

	return xiocb.xiocb_status;
}

int cfe_cpu_stop(int cpu)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_FW_CPUCTL;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_cpuctl);
	xiocb.plist.xiocb_cpuctl.cpu_number = cpu;
	xiocb.plist.xiocb_cpuctl.cpu_command = CFE_CPU_CMD_STOP;

	cfe_iocb_dispatch(&xiocb);

	return xiocb.xiocb_status;
}

int cfe_enumenv(int idx, char *name, int namelen, char *val, int vallen)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_ENV_SET;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_envbuf);
	xiocb.plist.xiocb_envbuf.enum_idx = idx;
	xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name);
	xiocb.plist.xiocb_envbuf.name_length = namelen;
	xiocb.plist.xiocb_envbuf.val_ptr = XPTR_FROM_NATIVE(val);
	xiocb.plist.xiocb_envbuf.val_length = vallen;

	cfe_iocb_dispatch(&xiocb);

	return xiocb.xiocb_status;
}

int
cfe_enummem(int idx, int flags, u64 *start, u64 *length, u64 *type)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_FW_MEMENUM;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = flags;
	xiocb.xiocb_psize = sizeof(struct xiocb_meminfo);
	xiocb.plist.xiocb_meminfo.mi_idx = idx;

	cfe_iocb_dispatch(&xiocb);

	if (xiocb.xiocb_status < 0)
		return xiocb.xiocb_status;

	*start = xiocb.plist.xiocb_meminfo.mi_addr;
	*length = xiocb.plist.xiocb_meminfo.mi_size;
	*type = xiocb.plist.xiocb_meminfo.mi_type;

	return 0;
}

int cfe_exit(int warm, int status)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_FW_RESTART;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = warm ? CFE_FLG_WARMSTART : 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_exitstat);
	xiocb.plist.xiocb_exitstat.status = status;

	cfe_iocb_dispatch(&xiocb);

	return xiocb.xiocb_status;
}

int cfe_flushcache(int flg)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_FW_FLUSHCACHE;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = flg;
	xiocb.xiocb_psize = 0;

	cfe_iocb_dispatch(&xiocb);

	return xiocb.xiocb_status;
}

int cfe_getdevinfo(char *name)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_DEV_GETINFO;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
	xiocb.plist.xiocb_buffer.buf_offset = 0;
	xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(name);
	xiocb.plist.xiocb_buffer.buf_length = strlen(name);

	cfe_iocb_dispatch(&xiocb);

	if (xiocb.xiocb_status < 0)
		return xiocb.xiocb_status;
	return xiocb.plist.xiocb_buffer.buf_ioctlcmd;
}

int cfe_getenv(char *name, char *dest, int destlen)
{
	struct cfe_xiocb xiocb;

	*dest = 0;

	xiocb.xiocb_fcode = CFE_CMD_ENV_GET;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_envbuf);
	xiocb.plist.xiocb_envbuf.enum_idx = 0;
	xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name);
	xiocb.plist.xiocb_envbuf.name_length = strlen(name);
	xiocb.plist.xiocb_envbuf.val_ptr = XPTR_FROM_NATIVE(dest);
	xiocb.plist.xiocb_envbuf.val_length = destlen;

	cfe_iocb_dispatch(&xiocb);

	return xiocb.xiocb_status;
}

int cfe_getfwinfo(cfe_fwinfo_t * info)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_FW_GETINFO;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_fwinfo);

	cfe_iocb_dispatch(&xiocb);

	if (xiocb.xiocb_status < 0)
		return xiocb.xiocb_status;

	info->fwi_version = xiocb.plist.xiocb_fwinfo.fwi_version;
	info->fwi_totalmem = xiocb.plist.xiocb_fwinfo.fwi_totalmem;
	info->fwi_flags = xiocb.plist.xiocb_fwinfo.fwi_flags;
	info->fwi_boardid = xiocb.plist.xiocb_fwinfo.fwi_boardid;
	info->fwi_bootarea_va = xiocb.plist.xiocb_fwinfo.fwi_bootarea_va;
	info->fwi_bootarea_pa = xiocb.plist.xiocb_fwinfo.fwi_bootarea_pa;
	info->fwi_bootarea_size =
	    xiocb.plist.xiocb_fwinfo.fwi_bootarea_size;
#if 0
	info->fwi_reserved1 = xiocb.plist.xiocb_fwinfo.fwi_reserved1;
	info->fwi_reserved2 = xiocb.plist.xiocb_fwinfo.fwi_reserved2;
	info->fwi_reserved3 = xiocb.plist.xiocb_fwinfo.fwi_reserved3;
#endif

	return 0;
}

int cfe_getstdhandle(int flg)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_DEV_GETHANDLE;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = flg;
	xiocb.xiocb_psize = 0;

	cfe_iocb_dispatch(&xiocb);

	if (xiocb.xiocb_status < 0)
		return xiocb.xiocb_status;
	return xiocb.xiocb_handle;
}

int64_t
cfe_getticks(void)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_FW_GETTIME;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_time);
	xiocb.plist.xiocb_time.ticks = 0;

	cfe_iocb_dispatch(&xiocb);

	return xiocb.plist.xiocb_time.ticks;

}

int cfe_inpstat(int handle)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_DEV_INPSTAT;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = handle;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_inpstat);
	xiocb.plist.xiocb_inpstat.inp_status = 0;

	cfe_iocb_dispatch(&xiocb);

	if (xiocb.xiocb_status < 0)
		return xiocb.xiocb_status;
	return xiocb.plist.xiocb_inpstat.inp_status;
}

int
cfe_ioctl(int handle, unsigned int ioctlnum, unsigned char *buffer,
	  int length, int *retlen, u64 offset)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_DEV_IOCTL;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = handle;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
	xiocb.plist.xiocb_buffer.buf_offset = offset;
	xiocb.plist.xiocb_buffer.buf_ioctlcmd = ioctlnum;
	xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer);
	xiocb.plist.xiocb_buffer.buf_length = length;

	cfe_iocb_dispatch(&xiocb);

	if (retlen)
		*retlen = xiocb.plist.xiocb_buffer.buf_retlen;
	return xiocb.xiocb_status;
}

int cfe_open(char *name)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_DEV_OPEN;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
	xiocb.plist.xiocb_buffer.buf_offset = 0;
	xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(name);
	xiocb.plist.xiocb_buffer.buf_length = strlen(name);

	cfe_iocb_dispatch(&xiocb);

	if (xiocb.xiocb_status < 0)
		return xiocb.xiocb_status;
	return xiocb.xiocb_handle;
}

int cfe_read(int handle, unsigned char *buffer, int length)
{
	return cfe_readblk(handle, 0, buffer, length);
}

int cfe_readblk(int handle, s64 offset, unsigned char *buffer, int length)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_DEV_READ;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = handle;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
	xiocb.plist.xiocb_buffer.buf_offset = offset;
	xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer);
	xiocb.plist.xiocb_buffer.buf_length = length;

	cfe_iocb_dispatch(&xiocb);

	if (xiocb.xiocb_status < 0)
		return xiocb.xiocb_status;
	return xiocb.plist.xiocb_buffer.buf_retlen;
}

int cfe_setenv(char *name, char *val)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_ENV_SET;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = 0;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_envbuf);
	xiocb.plist.xiocb_envbuf.enum_idx = 0;
	xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name);
	xiocb.plist.xiocb_envbuf.name_length = strlen(name);
	xiocb.plist.xiocb_envbuf.val_ptr = XPTR_FROM_NATIVE(val);
	xiocb.plist.xiocb_envbuf.val_length = strlen(val);

	cfe_iocb_dispatch(&xiocb);

	return xiocb.xiocb_status;
}

int cfe_write(int handle, const char *buffer, int length)
{
	return cfe_writeblk(handle, 0, buffer, length);
}

int cfe_writeblk(int handle, s64 offset, const char *buffer, int length)
{
	struct cfe_xiocb xiocb;

	xiocb.xiocb_fcode = CFE_CMD_DEV_WRITE;
	xiocb.xiocb_status = 0;
	xiocb.xiocb_handle = handle;
	xiocb.xiocb_flags = 0;
	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
	xiocb.plist.xiocb_buffer.buf_offset = offset;
	xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(buffer);
	xiocb.plist.xiocb_buffer.buf_length = length;

	cfe_iocb_dispatch(&xiocb);

	if (xiocb.xiocb_status < 0)
		return xiocb.xiocb_status;
	return xiocb.plist.xiocb_buffer.buf_retlen;
}
Commit	Line	Data
1a59d1b8	1	// SPDX-License-Identifier: GPL-2.0-or-later
1da177e4 LT	2	/*
1da177e4 LT	3	* Copyright (C) 2000, 2001, 2002 Broadcom Corporation
1da177e4 LT	4	*/
1da177e4 LT	5
417345d8 CH	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	*/
1da177e4	16
df78b5c8	17	#include <asm/fw/cfe/cfe_api.h>
1da177e4 LT	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
417345d8	24	int cfe_iocb_dispatch(struct cfe_xiocb *xiocb);
1da177e4	25
1da177e4 LT	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
982f6ffe RB	35	static int (*cfe_dispfunc) (intptr_t handle, intptr_t xiocb);
982f6ffe RB	36	static u64 cfe_handle;
1da177e4	37
417345d8	38	int cfe_init(u64 handle, u64 ept)
1da177e4 LT	39	{
	40	cfe_dispfunc = NATIVE_FROM_XPTR(ept);
	41	cfe_handle = handle;
	42	return 0;
	43	}
	44
417345d8	45	int cfe_iocb_dispatch(struct cfe_xiocb * xiocb)
1da177e4 LT	46	{
	47	if (!cfe_dispfunc)
	48	return -1;
	49	return (*cfe_dispfunc) ((intptr_t) cfe_handle, (intptr_t) xiocb);
	50	}
1da177e4	51
1da177e4 LT	52	int cfe_close(int handle)
1da177e4 LT	53	{
417345d8	54	struct cfe_xiocb xiocb;
1da177e4 LT	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	}
1da177e4	67
1da177e4 LT	68	int cfe_cpu_start(int cpu, void (*fn) (void), long sp, long gp, long a1)
1da177e4 LT	69	{
417345d8	70	struct cfe_xiocb xiocb;
1da177e4 LT	71
	72	xiocb.xiocb_fcode = CFE_CMD_FW_CPUCTL;
	73	xiocb.xiocb_status = 0;
	74	xiocb.xiocb_handle = 0;
	75	xiocb.xiocb_flags = 0;
417345d8	76	xiocb.xiocb_psize = sizeof(struct xiocb_cpuctl);
1da177e4 LT	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	}
1da177e4	88
1da177e4 LT	89	int cfe_cpu_stop(int cpu)
1da177e4 LT	90	{
417345d8	91	struct cfe_xiocb xiocb;
1da177e4 LT	92
	93	xiocb.xiocb_fcode = CFE_CMD_FW_CPUCTL;
	94	xiocb.xiocb_status = 0;
	95	xiocb.xiocb_handle = 0;
	96	xiocb.xiocb_flags = 0;
417345d8	97	xiocb.xiocb_psize = sizeof(struct xiocb_cpuctl);
1da177e4 LT	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	}
1da177e4	105
1da177e4 LT	106	int cfe_enumenv(int idx, char name, int namelen, char val, int vallen)
1da177e4 LT	107	{
417345d8	108	struct cfe_xiocb xiocb;
1da177e4 LT	109
	110	xiocb.xiocb_fcode = CFE_CMD_ENV_SET;
	111	xiocb.xiocb_status = 0;
	112	xiocb.xiocb_handle = 0;
	113	xiocb.xiocb_flags = 0;
417345d8	114	xiocb.xiocb_psize = sizeof(struct xiocb_envbuf);
1da177e4 LT	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	}
1da177e4	125
1da177e4	126	int
417345d8	127	cfe_enummem(int idx, int flags, u64 start, u64 length, u64 *type)
1da177e4	128	{
417345d8	129	struct cfe_xiocb xiocb;
1da177e4 LT	130
	131	xiocb.xiocb_fcode = CFE_CMD_FW_MEMENUM;
	132	xiocb.xiocb_status = 0;
	133	xiocb.xiocb_handle = 0;
	134	xiocb.xiocb_flags = flags;
417345d8	135	xiocb.xiocb_psize = sizeof(struct xiocb_meminfo);
1da177e4 LT	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	}
1da177e4	149
1da177e4 LT	150	int cfe_exit(int warm, int status)
1da177e4 LT	151	{
417345d8	152	struct cfe_xiocb xiocb;
1da177e4 LT	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;
417345d8	158	xiocb.xiocb_psize = sizeof(struct xiocb_exitstat);
1da177e4 LT	159	xiocb.plist.xiocb_exitstat.status = status;
	160
	161	cfe_iocb_dispatch(&xiocb);
	162
	163	return xiocb.xiocb_status;
	164	}
1da177e4	165
1da177e4 LT	166	int cfe_flushcache(int flg)
1da177e4 LT	167	{
417345d8	168	struct cfe_xiocb xiocb;
1da177e4 LT	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	}
1da177e4	180
1da177e4 LT	181	int cfe_getdevinfo(char *name)
1da177e4 LT	182	{
417345d8	183	struct cfe_xiocb xiocb;
1da177e4 LT	184
	185	xiocb.xiocb_fcode = CFE_CMD_DEV_GETINFO;
	186	xiocb.xiocb_status = 0;
	187	xiocb.xiocb_handle = 0;
	188	xiocb.xiocb_flags = 0;
417345d8	189	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
1da177e4 LT	190	xiocb.plist.xiocb_buffer.buf_offset = 0;
1da177e4 LT	191	xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(name);
417345d8	192	xiocb.plist.xiocb_buffer.buf_length = strlen(name);
1da177e4 LT	193
	194	cfe_iocb_dispatch(&xiocb);
	195
	196	if (xiocb.xiocb_status < 0)
	197	return xiocb.xiocb_status;
417345d8	198	return xiocb.plist.xiocb_buffer.buf_ioctlcmd;
1da177e4	199	}
1da177e4	200
1da177e4 LT	201	int cfe_getenv(char name, char dest, int destlen)
1da177e4 LT	202	{
417345d8	203	struct cfe_xiocb xiocb;
1da177e4 LT	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;
417345d8	211	xiocb.xiocb_psize = sizeof(struct xiocb_envbuf);
1da177e4 LT	212	xiocb.plist.xiocb_envbuf.enum_idx = 0;
1da177e4 LT	213	xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name);
417345d8	214	xiocb.plist.xiocb_envbuf.name_length = strlen(name);
1da177e4 LT	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	}
1da177e4	222
1da177e4 LT	223	int cfe_getfwinfo(cfe_fwinfo_t * info)
1da177e4 LT	224	{
417345d8	225	struct cfe_xiocb xiocb;
1da177e4 LT	226
	227	xiocb.xiocb_fcode = CFE_CMD_FW_GETINFO;
	228	xiocb.xiocb_status = 0;
	229	xiocb.xiocb_handle = 0;
	230	xiocb.xiocb_flags = 0;
417345d8	231	xiocb.xiocb_psize = sizeof(struct xiocb_fwinfo);
1da177e4 LT	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	}
1da177e4	254
1da177e4 LT	255	int cfe_getstdhandle(int flg)
1da177e4 LT	256	{
417345d8	257	struct cfe_xiocb xiocb;
1da177e4 LT	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	}
1da177e4	271
1da177e4	272	int64_t
1da177e4	273	cfe_getticks(void)
1da177e4	274	{
417345d8	275	struct cfe_xiocb xiocb;
1da177e4 LT	276
	277	xiocb.xiocb_fcode = CFE_CMD_FW_GETTIME;
	278	xiocb.xiocb_status = 0;
	279	xiocb.xiocb_handle = 0;
	280	xiocb.xiocb_flags = 0;
417345d8	281	xiocb.xiocb_psize = sizeof(struct xiocb_time);
1da177e4 LT	282	xiocb.plist.xiocb_time.ticks = 0;
	283
	284	cfe_iocb_dispatch(&xiocb);
	285
	286	return xiocb.plist.xiocb_time.ticks;
	287
	288	}
1da177e4	289
1da177e4 LT	290	int cfe_inpstat(int handle)
1da177e4 LT	291	{
417345d8	292	struct cfe_xiocb xiocb;
1da177e4 LT	293
	294	xiocb.xiocb_fcode = CFE_CMD_DEV_INPSTAT;
	295	xiocb.xiocb_status = 0;
	296	xiocb.xiocb_handle = handle;
	297	xiocb.xiocb_flags = 0;
417345d8	298	xiocb.xiocb_psize = sizeof(struct xiocb_inpstat);
1da177e4 LT	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	}
1da177e4	307
1da177e4 LT	308	int
1da177e4 LT	309	cfe_ioctl(int handle, unsigned int ioctlnum, unsigned char *buffer,
417345d8	310	int length, int *retlen, u64 offset)
1da177e4	311	{
417345d8	312	struct cfe_xiocb xiocb;
1da177e4 LT	313
	314	xiocb.xiocb_fcode = CFE_CMD_DEV_IOCTL;
	315	xiocb.xiocb_status = 0;
	316	xiocb.xiocb_handle = handle;
	317	xiocb.xiocb_flags = 0;
417345d8	318	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
1da177e4 LT	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	}
1da177e4	330
1da177e4 LT	331	int cfe_open(char *name)
1da177e4 LT	332	{
417345d8	333	struct cfe_xiocb xiocb;
1da177e4 LT	334
	335	xiocb.xiocb_fcode = CFE_CMD_DEV_OPEN;
	336	xiocb.xiocb_status = 0;
	337	xiocb.xiocb_handle = 0;
	338	xiocb.xiocb_flags = 0;
417345d8	339	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
1da177e4 LT	340	xiocb.plist.xiocb_buffer.buf_offset = 0;
1da177e4 LT	341	xiocb.plist.xiocb_buffer.buf_ptr = XPTR_FROM_NATIVE(name);
417345d8	342	xiocb.plist.xiocb_buffer.buf_length = strlen(name);
1da177e4 LT	343
	344	cfe_iocb_dispatch(&xiocb);
	345
	346	if (xiocb.xiocb_status < 0)
	347	return xiocb.xiocb_status;
	348	return xiocb.xiocb_handle;
	349	}
1da177e4	350
1da177e4 LT	351	int cfe_read(int handle, unsigned char *buffer, int length)
	352	{
	353	return cfe_readblk(handle, 0, buffer, length);
	354	}
1da177e4	355
417345d8	356	int cfe_readblk(int handle, s64 offset, unsigned char *buffer, int length)
1da177e4	357	{
417345d8	358	struct cfe_xiocb xiocb;
1da177e4 LT	359
	360	xiocb.xiocb_fcode = CFE_CMD_DEV_READ;
	361	xiocb.xiocb_status = 0;
	362	xiocb.xiocb_handle = handle;
	363	xiocb.xiocb_flags = 0;
417345d8	364	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
1da177e4 LT	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	}
1da177e4	375
1da177e4 LT	376	int cfe_setenv(char name, char val)
1da177e4 LT	377	{
417345d8	378	struct cfe_xiocb xiocb;
1da177e4 LT	379
	380	xiocb.xiocb_fcode = CFE_CMD_ENV_SET;
	381	xiocb.xiocb_status = 0;
	382	xiocb.xiocb_handle = 0;
	383	xiocb.xiocb_flags = 0;
417345d8	384	xiocb.xiocb_psize = sizeof(struct xiocb_envbuf);
1da177e4 LT	385	xiocb.plist.xiocb_envbuf.enum_idx = 0;
1da177e4 LT	386	xiocb.plist.xiocb_envbuf.name_ptr = XPTR_FROM_NATIVE(name);
417345d8	387	xiocb.plist.xiocb_envbuf.name_length = strlen(name);
1da177e4	388	xiocb.plist.xiocb_envbuf.val_ptr = XPTR_FROM_NATIVE(val);
417345d8	389	xiocb.plist.xiocb_envbuf.val_length = strlen(val);
1da177e4 LT	390
	391	cfe_iocb_dispatch(&xiocb);
	392
	393	return xiocb.xiocb_status;
	394	}
1da177e4	395
39b6f3aa	396	int cfe_write(int handle, const char *buffer, int length)
1da177e4 LT	397	{
	398	return cfe_writeblk(handle, 0, buffer, length);
	399	}
1da177e4	400
39b6f3aa	401	int cfe_writeblk(int handle, s64 offset, const char *buffer, int length)
1da177e4	402	{
417345d8	403	struct cfe_xiocb xiocb;
1da177e4 LT	404
	405	xiocb.xiocb_fcode = CFE_CMD_DEV_WRITE;
	406	xiocb.xiocb_status = 0;
	407	xiocb.xiocb_handle = handle;
	408	xiocb.xiocb_flags = 0;
417345d8	409	xiocb.xiocb_psize = sizeof(struct xiocb_buffer);
1da177e4 LT	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	}