xref: /onnv-gate/usr/src/lib/efcode/fcdriver/dma.c (revision 0:68f95e015346)
1*0Sstevel@tonic-gate /*
2*0Sstevel@tonic-gate  * CDDL HEADER START
3*0Sstevel@tonic-gate  *
4*0Sstevel@tonic-gate  * The contents of this file are subject to the terms of the
5*0Sstevel@tonic-gate  * Common Development and Distribution License, Version 1.0 only
6*0Sstevel@tonic-gate  * (the "License").  You may not use this file except in compliance
7*0Sstevel@tonic-gate  * with the License.
8*0Sstevel@tonic-gate  *
9*0Sstevel@tonic-gate  * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
10*0Sstevel@tonic-gate  * or http://www.opensolaris.org/os/licensing.
11*0Sstevel@tonic-gate  * See the License for the specific language governing permissions
12*0Sstevel@tonic-gate  * and limitations under the License.
13*0Sstevel@tonic-gate  *
14*0Sstevel@tonic-gate  * When distributing Covered Code, include this CDDL HEADER in each
15*0Sstevel@tonic-gate  * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
16*0Sstevel@tonic-gate  * If applicable, add the following below this CDDL HEADER, with the
17*0Sstevel@tonic-gate  * fields enclosed by brackets "[]" replaced with your own identifying
18*0Sstevel@tonic-gate  * information: Portions Copyright [yyyy] [name of copyright owner]
19*0Sstevel@tonic-gate  *
20*0Sstevel@tonic-gate  * CDDL HEADER END
21*0Sstevel@tonic-gate  */
22*0Sstevel@tonic-gate /*
23*0Sstevel@tonic-gate  * Copyright (c) 1999 by Sun Microsystems, Inc.
24*0Sstevel@tonic-gate  * All rights reserved.
25*0Sstevel@tonic-gate  */
26*0Sstevel@tonic-gate 
27*0Sstevel@tonic-gate #pragma ident	"%Z%%M%	%I%	%E% SMI"
28*0Sstevel@tonic-gate 
29*0Sstevel@tonic-gate #include <stdio.h>
30*0Sstevel@tonic-gate #include <stdlib.h>
31*0Sstevel@tonic-gate #include <strings.h>
32*0Sstevel@tonic-gate #include <fcode/private.h>
33*0Sstevel@tonic-gate #include <fcode/log.h>
34*0Sstevel@tonic-gate 
35*0Sstevel@tonic-gate #include <fcdriver/fcdriver.h>
36*0Sstevel@tonic-gate 
37*0Sstevel@tonic-gate 
38*0Sstevel@tonic-gate static void
do_dma_alloc(fcode_env_t * env)39*0Sstevel@tonic-gate do_dma_alloc(fcode_env_t *env)
40*0Sstevel@tonic-gate {
41*0Sstevel@tonic-gate 	size_t size;
42*0Sstevel@tonic-gate 	void *p;
43*0Sstevel@tonic-gate 
44*0Sstevel@tonic-gate 	CHECK_DEPTH(env, 1, "dma-alloc");
45*0Sstevel@tonic-gate 	size = (size_t) POP(DS);
46*0Sstevel@tonic-gate 	p = valloc(size);
47*0Sstevel@tonic-gate 	debug_msg(DEBUG_REG_ACCESS, "dma-alloc ( %x ) -> %p\n", (int)size, p);
48*0Sstevel@tonic-gate 	throw_from_fclib(env, (p == 0), "dma-alloc failed");
49*0Sstevel@tonic-gate 	PUSH(DS, (fstack_t) p);
50*0Sstevel@tonic-gate }
51*0Sstevel@tonic-gate 
52*0Sstevel@tonic-gate static void
do_dma_free(fcode_env_t * env)53*0Sstevel@tonic-gate do_dma_free(fcode_env_t *env)
54*0Sstevel@tonic-gate {
55*0Sstevel@tonic-gate 	void *p;
56*0Sstevel@tonic-gate 	size_t size;
57*0Sstevel@tonic-gate 
58*0Sstevel@tonic-gate 	CHECK_DEPTH(env, 2, "dma-free");
59*0Sstevel@tonic-gate 	size = POP(DS);
60*0Sstevel@tonic-gate 	p = (void *) POP(DS);
61*0Sstevel@tonic-gate 	debug_msg(DEBUG_REG_ACCESS, "dma-free ( %p %x )\n", p, (int)size);
62*0Sstevel@tonic-gate 
63*0Sstevel@tonic-gate 	free(p);
64*0Sstevel@tonic-gate }
65*0Sstevel@tonic-gate 
66*0Sstevel@tonic-gate static void
do_dma_map_in(fcode_env_t * env)67*0Sstevel@tonic-gate do_dma_map_in(fcode_env_t *env)
68*0Sstevel@tonic-gate {
69*0Sstevel@tonic-gate 	fc_cell_t data;
70*0Sstevel@tonic-gate 	fstack_t va, len, cacheable;
71*0Sstevel@tonic-gate 	private_data_t *pd = DEVICE_PRIVATE(env);
72*0Sstevel@tonic-gate 	int error;
73*0Sstevel@tonic-gate 
74*0Sstevel@tonic-gate 	CHECK_DEPTH(env, 3, "dma-map-in");
75*0Sstevel@tonic-gate 	cacheable = POP(DS);
76*0Sstevel@tonic-gate 	len = POP(DS);
77*0Sstevel@tonic-gate 	va = POP(DS);
78*0Sstevel@tonic-gate 
79*0Sstevel@tonic-gate 	error = fc_run_priv(pd->common, "dma-map-in", 3, 1,
80*0Sstevel@tonic-gate 	    fc_int2cell(cacheable), fc_size2cell(len), fc_ptr2cell(va),
81*0Sstevel@tonic-gate 	    &data);
82*0Sstevel@tonic-gate 
83*0Sstevel@tonic-gate 	throw_from_fclib(env, error, "dma-map-in failed");
84*0Sstevel@tonic-gate 
85*0Sstevel@tonic-gate 	PUSH(DS, (fstack_t)data);
86*0Sstevel@tonic-gate }
87*0Sstevel@tonic-gate 
88*0Sstevel@tonic-gate static void
do_dma_map_out(fcode_env_t * env)89*0Sstevel@tonic-gate do_dma_map_out(fcode_env_t *env)
90*0Sstevel@tonic-gate {
91*0Sstevel@tonic-gate 	fstack_t va, dva, len;
92*0Sstevel@tonic-gate 	private_data_t *pd = DEVICE_PRIVATE(env);
93*0Sstevel@tonic-gate 	int error;
94*0Sstevel@tonic-gate 
95*0Sstevel@tonic-gate 	CHECK_DEPTH(env, 3, "dma-map-out");
96*0Sstevel@tonic-gate 	len = POP(DS);
97*0Sstevel@tonic-gate 	dva = POP(DS);
98*0Sstevel@tonic-gate 	va = POP(DS);
99*0Sstevel@tonic-gate 
100*0Sstevel@tonic-gate 	error = fc_run_priv(pd->common, "dma-map-out", 3, 0, fc_size2cell(len),
101*0Sstevel@tonic-gate 	    fc_ptr2cell(dva), fc_ptr2cell(va));
102*0Sstevel@tonic-gate 
103*0Sstevel@tonic-gate 	throw_from_fclib(env, error, "dma-map-out failed");
104*0Sstevel@tonic-gate }
105*0Sstevel@tonic-gate 
106*0Sstevel@tonic-gate static void
do_dma_sync(fcode_env_t * env)107*0Sstevel@tonic-gate do_dma_sync(fcode_env_t *env)
108*0Sstevel@tonic-gate {
109*0Sstevel@tonic-gate 	CHECK_DEPTH(env, 3, "dma-sync");
110*0Sstevel@tonic-gate 	/* 3drop */
111*0Sstevel@tonic-gate 	DS -= 3;
112*0Sstevel@tonic-gate }
113*0Sstevel@tonic-gate 
114*0Sstevel@tonic-gate void
install_dma_methods(fcode_env_t * env)115*0Sstevel@tonic-gate install_dma_methods(fcode_env_t *env)
116*0Sstevel@tonic-gate {
117*0Sstevel@tonic-gate 	FORTH(0,	"dma-alloc",		do_dma_alloc);
118*0Sstevel@tonic-gate 	FORTH(0,	"dma-free",		do_dma_free);
119*0Sstevel@tonic-gate 	FORTH(0,	"dma-map-in",		do_dma_map_in);
120*0Sstevel@tonic-gate 	FORTH(0,	"dma-map-out",		do_dma_map_out);
121*0Sstevel@tonic-gate 	FORTH(0,	"dma-sync",		do_dma_sync);
122*0Sstevel@tonic-gate 
123*0Sstevel@tonic-gate }
124