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 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 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 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 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 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 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