1/* 2 * CDDL HEADER START 3 * 4 * The contents of this file are subject to the terms of the 5 * Common Development and Distribution License, Version 1.0 only 6 * (the "License"). You may not use this file except in compliance 7 * with the License. 8 * 9 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE 10 * or http://www.opensolaris.org/os/licensing. 11 * See the License for the specific language governing permissions 12 * and limitations under the License. 13 * 14 * When distributing Covered Code, include this CDDL HEADER in each 15 * file and include the License file at usr/src/OPENSOLARIS.LICENSE. 16 * If applicable, add the following below this CDDL HEADER, with the 17 * fields enclosed by brackets "[]" replaced with your own identifying 18 * information: Portions Copyright [yyyy] [name of copyright owner] 19 * 20 * CDDL HEADER END 21 * 22 * Portions Copyright 2016 Ruslan Bukin <br@bsdpad.com> 23 * 24 * $FreeBSD$ 25 */ 26/* 27 * Copyright 2004 Sun Microsystems, Inc. All rights reserved. 28 * Use is subject to license terms. 29 */ 30 31#define _ASM 32#define _LOCORE 33 34#include <sys/cpuvar_defs.h> 35#include <sys/dtrace.h> 36 37#include <machine/riscvreg.h> 38#include <machine/asm.h> 39 40#include "assym.inc" 41 42/* 43void dtrace_membar_producer(void) 44*/ 45ENTRY(dtrace_membar_producer) 46 RET 47END(dtrace_membar_producer) 48 49/* 50void dtrace_membar_consumer(void) 51*/ 52ENTRY(dtrace_membar_consumer) 53 RET 54END(dtrace_membar_consumer) 55 56/* 57dtrace_icookie_t dtrace_interrupt_disable(void) 58*/ 59ENTRY(dtrace_interrupt_disable) 60 csrrci a0, sstatus, (SSTATUS_SIE) 61 andi a0, a0, (SSTATUS_SIE) 62 RET 63END(dtrace_interrupt_disable) 64 65/* 66void dtrace_interrupt_enable(dtrace_icookie_t cookie) 67*/ 68ENTRY(dtrace_interrupt_enable) 69 csrs sstatus, a0 70 RET 71END(dtrace_interrupt_enable) 72/* 73uint8_t 74dtrace_fuword8_nocheck(void *addr) 75*/ 76ENTRY(dtrace_fuword8_nocheck) 77 lb a0, 0(a0) 78 RET 79END(dtrace_fuword8_nocheck) 80 81/* 82uint16_t 83dtrace_fuword16_nocheck(void *addr) 84*/ 85ENTRY(dtrace_fuword16_nocheck) 86 lh a0, 0(a0) 87 RET 88END(dtrace_fuword16_nocheck) 89 90/* 91uint32_t 92dtrace_fuword32_nocheck(void *addr) 93*/ 94ENTRY(dtrace_fuword32_nocheck) 95 lw a0, 0(a0) 96 RET 97END(dtrace_fuword32_nocheck) 98 99/* 100uint64_t 101dtrace_fuword64_nocheck(void *addr) 102*/ 103ENTRY(dtrace_fuword64_nocheck) 104 ld a0, 0(a0) 105 RET 106END(dtrace_fuword64_nocheck) 107 108/* 109void 110dtrace_copy(uintptr_t uaddr, uintptr_t kaddr, size_t size) 111*/ 112ENTRY(dtrace_copy) 113 beqz a2, 2f /* If len == 0 then skip loop */ 1141: 115 lb a4, 0(a0) /* Load from uaddr */ 116 addi a0, a0, 1 117 sb a4, 0(a1) /* Store in kaddr */ 118 addi a1, a1, 1 119 addi a2, a2, -1 /* len-- */ 120 bnez a2, 1b 1212: 122 RET 123END(dtrace_copy) 124 125/* 126void 127dtrace_copystr(uintptr_t uaddr, uintptr_t kaddr, size_t size, 128 volatile uint16_t *flags) 129XXX: Check for flags? 130*/ 131ENTRY(dtrace_copystr) 132 beqz a2, 2f /* If len == 0 then skip loop */ 133 lb a4, 0(a0) /* Load from uaddr */ 134 addi a0, a0, 1 135 sb a4, 0(a1) /* Store in kaddr */ 136 addi a1, a1, 1 137 beqz a4, 2f /* If == 0 then break */ 138 addi a2, a2, -1 /* len-- */ 139 bnez a2, 1b 1402: 141 RET 142END(dtrace_copystr) 143 144/* 145uintptr_t 146dtrace_caller(int aframes) 147*/ 148ENTRY(dtrace_caller) 149 li a0, -1 150 RET 151END(dtrace_caller) 152 153/* 154uint32_t 155dtrace_cas32(uint32_t *target, uint32_t cmp, uint32_t new) 156*/ 157ENTRY(dtrace_cas32) 1581: lr.w a3, 0(a0) /* Load target */ 159 bne a3, a1, 2f /* *target != cmp ? return */ 160 sc.w a4, a2, 0(a0) /* Store new to target */ 161 bnez a4, 1b /* Try again if store not succeed */ 1622: mv a0, a3 /* Return the value loaded from target */ 163 RET 164END(dtrace_cas32) 165 166/* 167void * 168dtrace_casptr(volatile void *target, volatile void *cmp, volatile void *new) 169*/ 170ENTRY(dtrace_casptr) 1711: lr.d a3, 0(a0) /* Load target */ 172 bne a3, a1, 2f /* *target != cmp ? return */ 173 sc.d a4, a2, 0(a0) /* Store new to target */ 174 bnez a4, 1b /* Try again if store not succeed */ 1752: mv a0, a3 /* Return the value loaded from target */ 176 RET 177END(dtrace_casptr) 178