OpenSolaris_b135/lib/efcode/fcdriver/dma.c

/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License, Version 1.0 only
 * (the "License").  You may not use this file except in compliance
 * with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */
/*
 * Copyright (c) 1999 by Sun Microsystems, Inc.
 * All rights reserved.
 */

#pragma ident	"%Z%%M%	%I%	%E% SMI"

#include <stdio.h>
#include <stdlib.h>
#include <strings.h>
#include <fcode/private.h>
#include <fcode/log.h>

#include <fcdriver/fcdriver.h>


static void
do_dma_alloc(fcode_env_t *env)
{
	size_t size;
	void *p;

	CHECK_DEPTH(env, 1, "dma-alloc");
	size = (size_t) POP(DS);
	p = valloc(size);
	debug_msg(DEBUG_REG_ACCESS, "dma-alloc ( %x ) -> %p\n", (int)size, p);
	throw_from_fclib(env, (p == 0), "dma-alloc failed");
	PUSH(DS, (fstack_t) p);
}

static void
do_dma_free(fcode_env_t *env)
{
	void *p;
	size_t size;

	CHECK_DEPTH(env, 2, "dma-free");
	size = POP(DS);
	p = (void *) POP(DS);
	debug_msg(DEBUG_REG_ACCESS, "dma-free ( %p %x )\n", p, (int)size);

	free(p);
}

static void
do_dma_map_in(fcode_env_t *env)
{
	fc_cell_t data;
	fstack_t va, len, cacheable;
	private_data_t *pd = DEVICE_PRIVATE(env);
	int error;

	CHECK_DEPTH(env, 3, "dma-map-in");
	cacheable = POP(DS);
	len = POP(DS);
	va = POP(DS);

	error = fc_run_priv(pd->common, "dma-map-in", 3, 1,
	    fc_int2cell(cacheable), fc_size2cell(len), fc_ptr2cell(va),
	    &data);

	throw_from_fclib(env, error, "dma-map-in failed");

	PUSH(DS, (fstack_t)data);
}

static void
do_dma_map_out(fcode_env_t *env)
{
	fstack_t va, dva, len;
	private_data_t *pd = DEVICE_PRIVATE(env);
	int error;

	CHECK_DEPTH(env, 3, "dma-map-out");
	len = POP(DS);
	dva = POP(DS);
	va = POP(DS);

	error = fc_run_priv(pd->common, "dma-map-out", 3, 0, fc_size2cell(len),
	    fc_ptr2cell(dva), fc_ptr2cell(va));

	throw_from_fclib(env, error, "dma-map-out failed");
}

static void
do_dma_sync(fcode_env_t *env)
{
	CHECK_DEPTH(env, 3, "dma-sync");
	/* 3drop */
	DS -= 3;
}

void
install_dma_methods(fcode_env_t *env)
{
	FORTH(0,	"dma-alloc",		do_dma_alloc);
	FORTH(0,	"dma-free",		do_dma_free);
	FORTH(0,	"dma-map-in",		do_dma_map_in);
	FORTH(0,	"dma-map-out",		do_dma_map_out);
	FORTH(0,	"dma-sync",		do_dma_sync);

}