Files
2024-06-17 20:18:01 +08:00

293 lines
8.8 KiB
C

/* SPDX-License-Identifier: GPL-2.0 */
/*
* Format of an instruction in memory.
*
* This file is subject to the terms and conditions of the GNU General Public
* License. See the file "COPYING" in the main directory of this archive
* for more details.
*
* Copyright (C) 2020 Loongson Technology Co., Ltd.
*/
#ifndef _ASM_INST_H
#define _ASM_INST_H
#include <linux/types.h>
#include <asm/asm.h>
#include <asm/errno.h>
#include <asm/ptrace.h>
#include <uapi/asm/inst.h>
/* HACHACHAHCAHC ... */
/* In case some other massaging is needed, keep LOONGARCHInst as wrapper */
#define LOONGARCHInst(x) x
#define I_OPCODE_SFT 26
#define LOONGARCHInst_OPCODE(x) (LOONGARCHInst(x) >> I_OPCODE_SFT)
#define I_JTARGET_SFT 0
#define LOONGARCHInst_JTARGET(x) (LOONGARCHInst(x) & 0x03ffffff)
#define I_RS_SFT 21
#define LOONGARCHInst_RS(x) ((LOONGARCHInst(x) & 0x03e00000) >> I_RS_SFT)
#define I_RT_SFT 16
#define LOONGARCHInst_RT(x) ((LOONGARCHInst(x) & 0x001f0000) >> I_RT_SFT)
#define I_IMM_SFT 0
#define LOONGARCHInst_SIMM(x) ((int)((short)(LOONGARCHInst(x) & 0xffff)))
#define LOONGARCHInst_UIMM(x) (LOONGARCHInst(x) & 0xffff)
#define I_CACHEOP_SFT 18
#define LOONGARCHInst_CACHEOP(x) ((LOONGARCHInst(x) & 0x001c0000) >> I_CACHEOP_SFT)
#define I_CACHESEL_SFT 16
#define LOONGARCHInst_CACHESEL(x) ((LOONGARCHInst(x) & 0x00030000) >> I_CACHESEL_SFT)
#define I_RD_SFT 11
#define LOONGARCHInst_RD(x) ((LOONGARCHInst(x) & 0x0000f800) >> I_RD_SFT)
#define I_RE_SFT 6
#define LOONGARCHInst_RE(x) ((LOONGARCHInst(x) & 0x000007c0) >> I_RE_SFT)
#define I_FUNC_SFT 0
#define LOONGARCHInst_FUNC(x) (LOONGARCHInst(x) & 0x0000003f)
#define I_FFMT_SFT 21
#define LOONGARCHInst_FFMT(x) ((LOONGARCHInst(x) & 0x01e00000) >> I_FFMT_SFT)
#define I_FT_SFT 16
#define LOONGARCHInst_FT(x) ((LOONGARCHInst(x) & 0x001f0000) >> I_FT_SFT)
#define I_FS_SFT 11
#define LOONGARCHInst_FS(x) ((LOONGARCHInst(x) & 0x0000f800) >> I_FS_SFT)
#define I_FD_SFT 6
#define LOONGARCHInst_FD(x) ((LOONGARCHInst(x) & 0x000007c0) >> I_FD_SFT)
#define I_FR_SFT 21
#define LOONGARCHInst_FR(x) ((LOONGARCHInst(x) & 0x03e00000) >> I_FR_SFT)
#define I_FMA_FUNC_SFT 2
#define LOONGARCHInst_FMA_FUNC(x) ((LOONGARCHInst(x) & 0x0000003c) >> I_FMA_FUNC_SFT)
#define I_FMA_FFMT_SFT 0
#define LOONGARCHInst_FMA_FFMT(x) (LOONGARCHInst(x) & 0x00000003)
#define Inst_UncondBranchSIMM(x) \
((int)((((LOONGARCHInst(x) & 0x3ff) | ((LOONGARCHInst(x) & 0x200) ? 0xfffffc00 : 0)) << 16) \
| ((LOONGARCHInst(x) & 0x3fffc00) >> 10)))
typedef unsigned int loongarch_instruction;
/* Recode table from 16-bit register notation to 32-bit GPR. Do NOT export!!! */
extern const int reg16to32[];
#define STR(x) __STR(x)
#define __STR(x) #x
#define _LoadHW(addr, value, res) \
do { \
__asm__ __volatile__ ( \
"1:\tld.b\t%0, %2, 1\n" \
"2:\tld.bu\t$r19, %2, 0\n\t" \
"slli.w\t%0, %0, 0x8\n\t" \
"or\t%0, %0, $r19\n\t" \
"li.w\t%1, 0\n" \
"3:\n\t" \
".section\t.fixup,\"ax\"\n\t" \
"4:\tli.w\t%1, %3\n\t" \
"b\t3b\n\t" \
".previous\n\t" \
".section\t__ex_table,\"a\"\n\t" \
STR(PTR)"\t1b, 4b\n\t" \
STR(PTR)"\t2b, 4b\n\t" \
".previous" \
: "=&r" (value), "=r" (res) \
: "r" (addr), "i" (-EFAULT) \
: "$r19"); \
} while (0)
#define _LoadHWU(addr, value, res) \
do { \
__asm__ __volatile__ ( \
"1:\tld.bu\t%0, %2, 1\n" \
"2:\tld.bu\t$r19, %2, 0\n\t" \
"slli.w\t%0, %0, 0x8\n\t" \
"or\t%0, %0, $r19\n\t" \
"li.w\t%1, 0\n" \
"3:\n\t" \
".section\t.fixup,\"ax\"\n\t" \
"4:\tli.w\t%1, %3\n\t" \
"b\t3b\n\t" \
".previous\n\t" \
".section\t__ex_table,\"a\"\n\t" \
STR(PTR)"\t1b, 4b\n\t" \
STR(PTR)"\t2b, 4b\n\t" \
".previous" \
: "=&r" (value), "=r" (res) \
: "r" (addr), "i" (-EFAULT) \
: "$r19"); \
} while (0)
#define _StoreHW(addr, value, res) \
do { \
__asm__ __volatile__ ( \
"1:\tst.b\t%1, %2, 0\n" \
"srli.w\t$r19,%1, 0x8\n" \
"2:\tst.b\t$r19, %2, 1\n" \
"li.w\t%0, 0\n" \
"3:\n\t" \
".section\t.fixup,\"ax\"\n\t" \
"4:\tli.w\t%0, %3\n\t" \
"b\t3b\n\t" \
".previous\n\t" \
".section\t__ex_table,\"a\"\n\t" \
STR(PTR)"\t1b, 4b\n\t" \
STR(PTR)"\t2b, 4b\n\t" \
".previous" \
: "=r" (res) \
: "r" (value), "r" (addr), "i" (-EFAULT) \
: "$r19"); \
} while (0)
#define LoadHWU(addr, value, res) _LoadHWU(addr, value, res)
#define LoadHW(addr, value, res) _LoadHW(addr, value, res)
#define StoreHW(addr, value, res) _StoreHW(addr, value, res)
#define LOONGARCH_INSN_SIZE sizeof(union loongarch_instruction)
enum loongarch_gpr {
LOONGARCH_GPR_ZERO = 0,
LOONGARCH_GPR_RA = 1,
LOONGARCH_GPR_TP = 2,
LOONGARCH_GPR_SP = 3,
LOONGARCH_GPR_A0 = 4,
LOONGARCH_GPR_A1,
LOONGARCH_GPR_A2,
LOONGARCH_GPR_A3,
LOONGARCH_GPR_A4,
LOONGARCH_GPR_A5,
LOONGARCH_GPR_A6,
LOONGARCH_GPR_A7,
LOONGARCH_GPR_V0 = 4,
LOONGARCH_GPR_V1 = 5,
LOONGARCH_GPR_T0 = 12,
LOONGARCH_GPR_T1,
LOONGARCH_GPR_T2,
LOONGARCH_GPR_T3,
LOONGARCH_GPR_T4,
LOONGARCH_GPR_T5,
LOONGARCH_GPR_T6,
LOONGARCH_GPR_T7,
LOONGARCH_GPR_T8,
LOONGARCH_GPR_FP = 22,
LOONGARCH_GPR_S0 = 23,
LOONGARCH_GPR_S1,
LOONGARCH_GPR_S2,
LOONGARCH_GPR_S3,
LOONGARCH_GPR_S4,
LOONGARCH_GPR_S5,
LOONGARCH_GPR_S6,
LOONGARCH_GPR_S7,
LOONGARCH_GPR_S8,
LOONGARCH_GPR_MAX
};
#define INSN_NOP 0x03400000
#define INSN_BREAK 0x0002a000
#define ADDR_IMMMASK_ADDU16ID 0x00000000FFFF0000
#define ADDR_IMMMASK_LU32ID 0x000FFFFF00000000
#define ADDR_IMMMASK_LU52ID 0xFFF0000000000000
#define ADDR_IMMSHIFT_ADDU16ID 16
#define ADDR_IMMSHIFT_LU32ID 32
#define ADDR_IMMSHIFT_LU52ID 52
#define ADDR_IMM(addr, INSN) ((addr & ADDR_IMMMASK_##INSN) >> ADDR_IMMSHIFT_##INSN)
static inline bool cond_beqz(struct pt_regs *regs, int rj)
{
return regs->regs[rj] == 0;
}
static inline bool cond_bnez(struct pt_regs *regs, int rj)
{
return regs->regs[rj] != 0;
}
static inline bool cond_beq(struct pt_regs *regs, int rj, int rd)
{
return regs->regs[rj] == regs->regs[rd];
}
static inline bool cond_bne(struct pt_regs *regs, int rj, int rd)
{
return regs->regs[rj] != regs->regs[rd];
}
static inline bool cond_blt(struct pt_regs *regs, int rj, int rd)
{
return (long)regs->regs[rj] < (long)regs->regs[rd];
}
static inline bool cond_bge(struct pt_regs *regs, int rj, int rd)
{
return (long)regs->regs[rj] >= (long)regs->regs[rd];
}
static inline bool cond_bltu(struct pt_regs *regs, int rj, int rd)
{
return regs->regs[rj] < regs->regs[rd];
}
static inline bool cond_bgeu(struct pt_regs *regs, int rj, int rd)
{
return regs->regs[rj] >= regs->regs[rd];
}
static inline bool is_branch_insn(union loongarch_instruction insn)
{
return insn.reg1i21_format.opcode >= beqz_op &&
insn.reg1i21_format.opcode <= bgeu_op;
}
static inline bool is_pc_insn(union loongarch_instruction insn)
{
return insn.reg1i20_format.opcode >= pcaddi_op &&
insn.reg1i20_format.opcode <= pcaddu18i_op;
}
unsigned long bs_dest_16(unsigned long now, unsigned int si);
unsigned long bs_dest_21(unsigned long now, unsigned int h, unsigned int l);
unsigned long bs_dest_26(unsigned long now, unsigned int h, unsigned int l);
int simu_branch(struct pt_regs *regs, union loongarch_instruction insn);
int simu_pc(struct pt_regs *regs, union loongarch_instruction insn);
int larch_insn_read(void *addr, u32 *insnp);
int larch_insn_write(void *addr, u32 insn);
int larch_insn_patch_text(void *addr, u32 insn);
u32 larch_insn_gen_nop(void);
u32 larch_insn_gen_b(unsigned long pc, unsigned long dest);
u32 larch_insn_gen_bl(unsigned long pc, unsigned long dest);
u32 larch_insn_gen_addu16id(enum loongarch_gpr rd, enum loongarch_gpr rj, int imm);
u32 larch_insn_gen_lu32id(enum loongarch_gpr rd, int imm);
u32 larch_insn_gen_lu52id(enum loongarch_gpr rd, enum loongarch_gpr rj, int imm);
u32 larch_insn_gen_jirl(enum loongarch_gpr rd, enum loongarch_gpr rj,
unsigned long pc, unsigned long dest);
u32 larch_insn_gen_or(enum loongarch_gpr rd, enum loongarch_gpr rj,
enum loongarch_gpr rk);
u32 larch_insn_gen_move(enum loongarch_gpr rd, enum loongarch_gpr rj);
#endif /* _ASM_INST_H */