freebsd-dev/sys/mips/rmi/rmi_mips_exts.h

145 lines
4.1 KiB
C
Raw Normal View History

/*-
* Copyright (c) 2003-2009 RMI Corporation
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. Neither the name of RMI Corporation, nor the names of its contributors,
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* RMI_BSD */
#ifndef __MIPS_EXTS_H__
#define __MIPS_EXTS_H__
#define enable_KX(flags) __asm__ __volatile__ ( \
".set push\n" \
".set noat\n" \
".set noreorder\n" \
"mfc0 %0, $12\n\t" \
"ori $1, %0, 0x81\n\t" \
"xori $1, 1\n\t" \
"mtc0 $1, $12\n" \
".set pop\n" \
: "=r"(flags) )
#define disable_KX(flags) __asm__ __volatile__ ( \
".set push\n" \
"mtc0 %0, $12\n" \
".set pop\n" \
: : "r"(flags) )
#define CPU_BLOCKID_IFU 0
#define CPU_BLOCKID_ICU 1
#define CPU_BLOCKID_IEU 2
#define CPU_BLOCKID_LSU 3
#define CPU_BLOCKID_MMU 4
#define CPU_BLOCKID_PRF 5
#define LSU_CERRLOG_REGID 9
static __inline__ unsigned int read_32bit_phnx_ctrl_reg(int block, int reg)
{
unsigned int __res;
__asm__ __volatile__(
".set\tpush\n\t"
".set\tnoreorder\n\t"
"move $9, %1\n"
/* "mfcr\t$8, $9\n\t" */
".word 0x71280018\n"
"move %0, $8\n"
".set\tpop"
: "=r" (__res) : "r"((block<<8)|reg)
: "$8", "$9"
);
return __res;
}
static __inline__ void write_32bit_phnx_ctrl_reg(int block, int reg, unsigned int value)
{
__asm__ __volatile__(
".set\tpush\n\t"
".set\tnoreorder\n\t"
"move $8, %0\n"
"move $9, %1\n"
/* "mtcr\t$8, $9\n\t" */
".word 0x71280019\n"
".set\tpop"
:
: "r" (value), "r"((block<<8)|reg)
: "$8", "$9"
);
}
static __inline__ unsigned long long read_64bit_phnx_ctrl_reg(int block, int reg)
{
unsigned int high, low;
__asm__ __volatile__(
".set\tmips64\n\t"
"move $9, %2\n"
/* "mfcr $8, $9\n" */
".word 0x71280018\n"
"dsrl32 %0, $8, 0\n\t"
"dsll32 $8, $8, 0\n\t"
"dsrl32 %1, $8, 0\n\t"
".set mips0"
: "=r" (high), "=r"(low)
: "r"((block<<8)|reg)
: "$8", "$9"
);
return ( (((unsigned long long)high)<<32) | low);
}
static __inline__ void write_64bit_phnx_ctrl_reg(int block, int reg,unsigned long long value)
{
__uint32_t low, high;
high = value >> 32;
low = value & 0xffffffff;
__asm__ __volatile__(
".set push\n"
".set noreorder\n"
".set mips4\n\t"
/* Set up "rs" */
"move $9, %0\n"
/* Store 64 bit value in "rt" */
"dsll32 $10, %1, 0 \n\t"
"dsll32 $8, %2, 0 \n\t"
"dsrl32 $8, $8, 0 \n\t"
"or $10, $8, $8 \n\t"
".word 0x71280019\n" /* mtcr $8, $9 */
".set pop\n"
: /* No outputs */
: "r"((block<<8)|reg), "r" (high), "r" (low)
: "$8", "$9", "$10"
);
}
#endif