mirror of https://gitee.com/openkylin/linux.git
MIPS: Loongson: Add CFUCFG&CSR support
Loongson-3A R4+ (Loongson-3A4000 and newer) has CPUCFG (CPU config) and CSR (Control and Status Register) extensions. This patch add read/write functionalities for them. Signed-off-by: Huacai Chen <chenhc@lemote.com> Signed-off-by: Jiaxun Yang <jiaxun.yang@flygoat.com> Signed-off-by: Paul Burton <paul.burton@mips.com> Cc: Ralf Baechle <ralf@linux-mips.org> Cc: James Hogan <jhogan@kernel.org> Cc: linux-mips@linux-mips.org Cc: linux-mips@vger.kernel.org Cc: Fuxin Zhang <zhangfx@lemote.com> Cc: Zhangjin Wu <wuzhangjin@gmail.com> Cc: Huacai Chen <chenhuacai@gmail.com>
This commit is contained in:
parent
397dc00e24
commit
6a6f9b7daf
|
@ -0,0 +1,227 @@
|
|||
/*
|
||||
* Read/Write Loongson Extension Registers
|
||||
*/
|
||||
|
||||
#ifndef _LOONGSON_REGS_H_
|
||||
#define _LOONGSON_REGS_H_
|
||||
|
||||
#include <linux/types.h>
|
||||
#include <linux/bits.h>
|
||||
|
||||
#include <asm/mipsregs.h>
|
||||
#include <asm/cpu.h>
|
||||
|
||||
static inline bool cpu_has_cfg(void)
|
||||
{
|
||||
return ((read_c0_prid() & PRID_IMP_MASK) == PRID_IMP_LOONGSON_64G);
|
||||
}
|
||||
|
||||
static inline u32 read_cpucfg(u32 reg)
|
||||
{
|
||||
u32 __res;
|
||||
|
||||
__asm__ __volatile__(
|
||||
"parse_r __res,%0\n\t"
|
||||
"parse_r reg,%1\n\t"
|
||||
".insn \n\t"
|
||||
".word (0xc8080118 | (reg << 21) | (__res << 11))\n\t"
|
||||
:"=r"(__res)
|
||||
:"r"(reg)
|
||||
:
|
||||
);
|
||||
return __res;
|
||||
}
|
||||
|
||||
/* Bit Domains for CFG registers */
|
||||
#define LOONGSON_CFG0 0x0
|
||||
#define LOONGSON_CFG0_PRID GENMASK(31, 0)
|
||||
|
||||
#define LOONGSON_CFG1 0x1
|
||||
#define LOONGSON_CFG1_FP BIT(0)
|
||||
#define LOONGSON_CFG1_FPREV GENMASK(3, 1)
|
||||
#define LOONGSON_CFG1_MMI BIT(4)
|
||||
#define LOONGSON_CFG1_MSA1 BIT(5)
|
||||
#define LOONGSON_CFG1_MSA2 BIT(6)
|
||||
#define LOONGSON_CFG1_CGP BIT(7)
|
||||
#define LOONGSON_CFG1_WRP BIT(8)
|
||||
#define LOONGSON_CFG1_LSX1 BIT(9)
|
||||
#define LOONGSON_CFG1_LSX2 BIT(10)
|
||||
#define LOONGSON_CFG1_LASX BIT(11)
|
||||
#define LOONGSON_CFG1_R6FXP BIT(12)
|
||||
#define LOONGSON_CFG1_R6CRCP BIT(13)
|
||||
#define LOONGSON_CFG1_R6FPP BIT(14)
|
||||
#define LOONGSON_CFG1_CNT64 BIT(15)
|
||||
#define LOONGSON_CFG1_LSLDR0 BIT(16)
|
||||
#define LOONGSON_CFG1_LSPREF BIT(17)
|
||||
#define LOONGSON_CFG1_LSPREFX BIT(18)
|
||||
#define LOONGSON_CFG1_LSSYNCI BIT(19)
|
||||
#define LOONGSON_CFG1_LSUCA BIT(20)
|
||||
#define LOONGSON_CFG1_LLSYNC BIT(21)
|
||||
#define LOONGSON_CFG1_TGTSYNC BIT(22)
|
||||
#define LOONGSON_CFG1_LLEXC BIT(23)
|
||||
#define LOONGSON_CFG1_SCRAND BIT(24)
|
||||
#define LOONGSON_CFG1_MUALP BIT(25)
|
||||
#define LOONGSON_CFG1_KMUALEN BIT(26)
|
||||
#define LOONGSON_CFG1_ITLBT BIT(27)
|
||||
#define LOONGSON_CFG1_LSUPERF BIT(28)
|
||||
#define LOONGSON_CFG1_SFBP BIT(29)
|
||||
#define LOONGSON_CFG1_CDMAP BIT(30)
|
||||
|
||||
#define LOONGSON_CFG2 0x2
|
||||
#define LOONGSON_CFG2_LEXT1 BIT(0)
|
||||
#define LOONGSON_CFG2_LEXT2 BIT(1)
|
||||
#define LOONGSON_CFG2_LEXT3 BIT(2)
|
||||
#define LOONGSON_CFG2_LSPW BIT(3)
|
||||
#define LOONGSON_CFG2_LBT1 BIT(4)
|
||||
#define LOONGSON_CFG2_LBT2 BIT(5)
|
||||
#define LOONGSON_CFG2_LBT3 BIT(6)
|
||||
#define LOONGSON_CFG2_LBTMMU BIT(7)
|
||||
#define LOONGSON_CFG2_LPMP BIT(8)
|
||||
#define LOONGSON_CFG2_LPMPREV GENMASK(11, 9)
|
||||
#define LOONGSON_CFG2_LAMO BIT(12)
|
||||
#define LOONGSON_CFG2_LPIXU BIT(13)
|
||||
#define LOONGSON_CFG2_LPIXUN BIT(14)
|
||||
#define LOONGSON_CFG2_LZVP BIT(15)
|
||||
#define LOONGSON_CFG2_LZVREV GENMASK(18, 16)
|
||||
#define LOONGSON_CFG2_LGFTP BIT(19)
|
||||
#define LOONGSON_CFG2_LGFTPREV GENMASK(22, 20)
|
||||
#define LOONGSON_CFG2_LLFTP BIT(23)
|
||||
#define LOONGSON_CFG2_LLFTPREV GENMASK(24, 26)
|
||||
#define LOONGSON_CFG2_LCSRP BIT(27)
|
||||
#define LOONGSON_CFG2_LDISBLIKELY BIT(28)
|
||||
|
||||
#define LOONGSON_CFG3 0x3
|
||||
#define LOONGSON_CFG3_LCAMP BIT(0)
|
||||
#define LOONGSON_CFG3_LCAMREV GENMASK(3, 1)
|
||||
#define LOONGSON_CFG3_LCAMNUM GENMASK(11, 4)
|
||||
#define LOONGSON_CFG3_LCAMKW GENMASK(19, 12)
|
||||
#define LOONGSON_CFG3_LCAMVW GENMASK(27, 20)
|
||||
|
||||
#define LOONGSON_CFG4 0x4
|
||||
#define LOONGSON_CFG4_CCFREQ GENMASK(31, 0)
|
||||
|
||||
#define LOONGSON_CFG5 0x5
|
||||
#define LOONGSON_CFG5_CFM GENMASK(15, 0)
|
||||
#define LOONGSON_CFG5_CFD GENMASK(31, 16)
|
||||
|
||||
#define LOONGSON_CFG6 0x6
|
||||
|
||||
#define LOONGSON_CFG7 0x7
|
||||
#define LOONGSON_CFG7_GCCAEQRP BIT(0)
|
||||
#define LOONGSON_CFG7_UCAWINP BIT(1)
|
||||
|
||||
static inline bool cpu_has_csr(void)
|
||||
{
|
||||
if (cpu_has_cfg())
|
||||
return (read_cpucfg(LOONGSON_CFG2) & LOONGSON_CFG2_LCSRP);
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
static inline u32 csr_readl(u32 reg)
|
||||
{
|
||||
u32 __res;
|
||||
|
||||
/* RDCSR reg, val */
|
||||
__asm__ __volatile__(
|
||||
"parse_r __res,%0\n\t"
|
||||
"parse_r reg,%1\n\t"
|
||||
".insn \n\t"
|
||||
".word (0xc8000118 | (reg << 21) | (__res << 11))\n\t"
|
||||
:"=r"(__res)
|
||||
:"r"(reg)
|
||||
:
|
||||
);
|
||||
return __res;
|
||||
}
|
||||
|
||||
static inline u64 csr_readq(u32 reg)
|
||||
{
|
||||
u64 __res;
|
||||
|
||||
/* DWRCSR reg, val */
|
||||
__asm__ __volatile__(
|
||||
"parse_r __res,%0\n\t"
|
||||
"parse_r reg,%1\n\t"
|
||||
".insn \n\t"
|
||||
".word (0xc8020118 | (reg << 21) | (__res << 11))\n\t"
|
||||
:"=r"(__res)
|
||||
:"r"(reg)
|
||||
:
|
||||
);
|
||||
return __res;
|
||||
}
|
||||
|
||||
static inline void csr_writel(u32 val, u32 reg)
|
||||
{
|
||||
/* WRCSR reg, val */
|
||||
__asm__ __volatile__(
|
||||
"parse_r reg,%0\n\t"
|
||||
"parse_r val,%1\n\t"
|
||||
".insn \n\t"
|
||||
".word (0xc8010118 | (reg << 21) | (val << 11))\n\t"
|
||||
:
|
||||
:"r"(reg),"r"(val)
|
||||
:
|
||||
);
|
||||
}
|
||||
|
||||
static inline void csr_writeq(u64 val, u32 reg)
|
||||
{
|
||||
/* DWRCSR reg, val */
|
||||
__asm__ __volatile__(
|
||||
"parse_r reg,%0\n\t"
|
||||
"parse_r val,%1\n\t"
|
||||
".insn \n\t"
|
||||
".word (0xc8030118 | (reg << 21) | (val << 11))\n\t"
|
||||
:
|
||||
:"r"(reg),"r"(val)
|
||||
:
|
||||
);
|
||||
}
|
||||
|
||||
/* Public CSR Register can also be accessed with regular addresses */
|
||||
#define CSR_PUBLIC_MMIO_BASE 0x1fe00000
|
||||
|
||||
#define MMIO_CSR(x) (void *)TO_UNCAC(CSR_PUBLIC_MMIO_BASE + x)
|
||||
|
||||
#define LOONGSON_CSR_FEATURES 0x8
|
||||
#define LOONGSON_CSRF_TEMP BIT(0)
|
||||
#define LOONGSON_CSRF_NODECNT BIT(1)
|
||||
#define LOONGSON_CSRF_MSI BIT(2)
|
||||
#define LOONGSON_CSRF_EXTIOI BIT(3)
|
||||
#define LOONGSON_CSRF_IPI BIT(4)
|
||||
#define LOONGSON_CSRF_FREQ BIT(5)
|
||||
|
||||
#define LOONGSON_CSR_VENDOR 0x10 /* Vendor name string, should be "Loongson" */
|
||||
#define LOONGSON_CSR_CPUNAME 0x20 /* Processor name string */
|
||||
#define LOONGSON_CSR_NODECNT 0x408
|
||||
#define LOONGSON_CSR_CPUTEMP 0x428
|
||||
|
||||
/* PerCore CSR, only accessable by local cores */
|
||||
#define LOONGSON_CSR_IPI_STATUS 0x1000
|
||||
#define LOONGSON_CSR_IPI_EN 0x1004
|
||||
#define LOONGSON_CSR_IPI_SET 0x1008
|
||||
#define LOONGSON_CSR_IPI_CLEAR 0x100c
|
||||
#define LOONGSON_CSR_IPI_SEND 0x1040
|
||||
#define CSR_IPI_SEND_IP_SHIFT 0
|
||||
#define CSR_IPI_SEND_CPU_SHIFT 16
|
||||
#define CSR_IPI_SEND_BLOCK BIT(31)
|
||||
|
||||
static inline u64 drdtime(void)
|
||||
{
|
||||
int rID = 0;
|
||||
u64 val = 0;
|
||||
|
||||
__asm__ __volatile__(
|
||||
"parse_r rID,%0\n\t"
|
||||
"parse_r val,%1\n\t"
|
||||
".insn \n\t"
|
||||
".word (0xc8090118 | (rID << 21) | (val << 11))\n\t"
|
||||
:"=r"(rID),"=r"(val)
|
||||
:
|
||||
);
|
||||
return val;
|
||||
}
|
||||
|
||||
#endif
|
Loading…
Reference in New Issue