147 lines
4.6 KiB
C
147 lines
4.6 KiB
C
|
/* SPDX-License-Identifier: GPL-2.0 */
|
||
|
|
#ifndef _SELFTESTS_POWERPC_INSTRUCTIONS_H
|
||
|
|
#define _SELFTESTS_POWERPC_INSTRUCTIONS_H
|
||
|
|
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <stdlib.h>
|
||
|
|
|
||
|
|
/* This defines the "copy" instruction from Power ISA 3.0 Book II, section 4.4. */
|
||
|
|
#define __COPY(RA, RB, L) \
|
||
|
|
(0x7c00060c | (RA) << (31-15) | (RB) << (31-20) | (L) << (31-10))
|
||
|
|
#define COPY(RA, RB, L) \
|
||
|
|
.long __COPY((RA), (RB), (L))
|
||
|
|
|
||
|
|
static inline void copy(void *i)
|
||
|
|
{
|
||
|
|
asm volatile(str(COPY(0, %0, 0))";"
|
||
|
|
:
|
||
|
|
: "b" (i)
|
||
|
|
: "memory"
|
||
|
|
);
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline void copy_first(void *i)
|
||
|
|
{
|
||
|
|
asm volatile(str(COPY(0, %0, 1))";"
|
||
|
|
:
|
||
|
|
: "b" (i)
|
||
|
|
: "memory"
|
||
|
|
);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* This defines the "paste" instruction from Power ISA 3.0 Book II, section 4.4. */
|
||
|
|
#define __PASTE(RA, RB, L, RC) \
|
||
|
|
(0x7c00070c | (RA) << (31-15) | (RB) << (31-20) | (L) << (31-10) | (RC) << (31-31))
|
||
|
|
#define PASTE(RA, RB, L, RC) \
|
||
|
|
.long __PASTE((RA), (RB), (L), (RC))
|
||
|
|
|
||
|
|
static inline int paste(void *i)
|
||
|
|
{
|
||
|
|
int cr;
|
||
|
|
|
||
|
|
asm volatile(str(PASTE(0, %1, 0, 0))";"
|
||
|
|
"mfcr %0;"
|
||
|
|
: "=r" (cr)
|
||
|
|
: "b" (i)
|
||
|
|
: "memory"
|
||
|
|
);
|
||
|
|
return cr;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline int paste_last(void *i)
|
||
|
|
{
|
||
|
|
int cr;
|
||
|
|
|
||
|
|
asm volatile(str(PASTE(0, %1, 1, 1))";"
|
||
|
|
"mfcr %0;"
|
||
|
|
: "=r" (cr)
|
||
|
|
: "b" (i)
|
||
|
|
: "memory"
|
||
|
|
);
|
||
|
|
return cr;
|
||
|
|
}
|
||
|
|
|
||
|
|
#define PPC_INST_COPY __COPY(0, 0, 0)
|
||
|
|
#define PPC_INST_COPY_FIRST __COPY(0, 0, 1)
|
||
|
|
#define PPC_INST_PASTE __PASTE(0, 0, 0, 0)
|
||
|
|
#define PPC_INST_PASTE_LAST __PASTE(0, 0, 1, 1)
|
||
|
|
|
||
|
|
/* This defines the prefixed load/store instructions */
|
||
|
|
#ifdef __ASSEMBLY__
|
||
|
|
# define stringify_in_c(...) __VA_ARGS__
|
||
|
|
#else
|
||
|
|
# define __stringify_in_c(...) #__VA_ARGS__
|
||
|
|
# define stringify_in_c(...) __stringify_in_c(__VA_ARGS__) " "
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#define __PPC_RA(a) (((a) & 0x1f) << 16)
|
||
|
|
#define __PPC_RS(s) (((s) & 0x1f) << 21)
|
||
|
|
#define __PPC_RT(t) __PPC_RS(t)
|
||
|
|
#define __PPC_PREFIX_R(r) (((r) & 0x1) << 20)
|
||
|
|
|
||
|
|
#define PPC_PREFIX_MLS 0x06000000
|
||
|
|
#define PPC_PREFIX_8LS 0x04000000
|
||
|
|
|
||
|
|
#define PPC_INST_LBZ 0x88000000
|
||
|
|
#define PPC_INST_LHZ 0xa0000000
|
||
|
|
#define PPC_INST_LHA 0xa8000000
|
||
|
|
#define PPC_INST_LWZ 0x80000000
|
||
|
|
#define PPC_INST_STB 0x98000000
|
||
|
|
#define PPC_INST_STH 0xb0000000
|
||
|
|
#define PPC_INST_STW 0x90000000
|
||
|
|
#define PPC_INST_STD 0xf8000000
|
||
|
|
#define PPC_INST_LFS 0xc0000000
|
||
|
|
#define PPC_INST_LFD 0xc8000000
|
||
|
|
#define PPC_INST_STFS 0xd0000000
|
||
|
|
#define PPC_INST_STFD 0xd8000000
|
||
|
|
|
||
|
|
#define PREFIX_MLS(instr, t, a, r, d) stringify_in_c(.balign 64, , 4;) \
|
||
|
|
stringify_in_c(.long PPC_PREFIX_MLS | \
|
||
|
|
__PPC_PREFIX_R(r) | \
|
||
|
|
(((d) >> 16) & 0x3ffff);) \
|
||
|
|
stringify_in_c(.long (instr) | \
|
||
|
|
__PPC_RT(t) | \
|
||
|
|
__PPC_RA(a) | \
|
||
|
|
((d) & 0xffff);\n)
|
||
|
|
|
||
|
|
#define PREFIX_8LS(instr, t, a, r, d) stringify_in_c(.balign 64, , 4;) \
|
||
|
|
stringify_in_c(.long PPC_PREFIX_8LS | \
|
||
|
|
__PPC_PREFIX_R(r) | \
|
||
|
|
(((d) >> 16) & 0x3ffff);) \
|
||
|
|
stringify_in_c(.long (instr) | \
|
||
|
|
__PPC_RT(t) | \
|
||
|
|
__PPC_RA(a) | \
|
||
|
|
((d) & 0xffff);\n)
|
||
|
|
|
||
|
|
/* Prefixed Integer Load/Store instructions */
|
||
|
|
#define PLBZ(t, a, r, d) PREFIX_MLS(PPC_INST_LBZ, t, a, r, d)
|
||
|
|
#define PLHZ(t, a, r, d) PREFIX_MLS(PPC_INST_LHZ, t, a, r, d)
|
||
|
|
#define PLHA(t, a, r, d) PREFIX_MLS(PPC_INST_LHA, t, a, r, d)
|
||
|
|
#define PLWZ(t, a, r, d) PREFIX_MLS(PPC_INST_LWZ, t, a, r, d)
|
||
|
|
#define PLWA(t, a, r, d) PREFIX_8LS(0xa4000000, t, a, r, d)
|
||
|
|
#define PLD(t, a, r, d) PREFIX_8LS(0xe4000000, t, a, r, d)
|
||
|
|
#define PLQ(t, a, r, d) PREFIX_8LS(0xe0000000, t, a, r, d)
|
||
|
|
#define PSTB(s, a, r, d) PREFIX_MLS(PPC_INST_STB, s, a, r, d)
|
||
|
|
#define PSTH(s, a, r, d) PREFIX_MLS(PPC_INST_STH, s, a, r, d)
|
||
|
|
#define PSTW(s, a, r, d) PREFIX_MLS(PPC_INST_STW, s, a, r, d)
|
||
|
|
#define PSTD(s, a, r, d) PREFIX_8LS(0xf4000000, s, a, r, d)
|
||
|
|
#define PSTQ(s, a, r, d) PREFIX_8LS(0xf0000000, s, a, r, d)
|
||
|
|
|
||
|
|
/* Prefixed Floating-Point Load/Store Instructions */
|
||
|
|
#define PLFS(frt, a, r, d) PREFIX_MLS(PPC_INST_LFS, frt, a, r, d)
|
||
|
|
#define PLFD(frt, a, r, d) PREFIX_MLS(PPC_INST_LFD, frt, a, r, d)
|
||
|
|
#define PSTFS(frs, a, r, d) PREFIX_MLS(PPC_INST_STFS, frs, a, r, d)
|
||
|
|
#define PSTFD(frs, a, r, d) PREFIX_MLS(PPC_INST_STFD, frs, a, r, d)
|
||
|
|
|
||
|
|
/* Prefixed VSX Load/Store Instructions */
|
||
|
|
#define PLXSD(vrt, a, r, d) PREFIX_8LS(0xa8000000, vrt, a, r, d)
|
||
|
|
#define PLXSSP(vrt, a, r, d) PREFIX_8LS(0xac000000, vrt, a, r, d)
|
||
|
|
#define PLXV0(s, a, r, d) PREFIX_8LS(0xc8000000, s, a, r, d)
|
||
|
|
#define PLXV1(s, a, r, d) PREFIX_8LS(0xcc000000, s, a, r, d)
|
||
|
|
#define PSTXSD(vrs, a, r, d) PREFIX_8LS(0xb8000000, vrs, a, r, d)
|
||
|
|
#define PSTXSSP(vrs, a, r, d) PREFIX_8LS(0xbc000000, vrs, a, r, d)
|
||
|
|
#define PSTXV0(s, a, r, d) PREFIX_8LS(0xd8000000, s, a, r, d)
|
||
|
|
#define PSTXV1(s, a, r, d) PREFIX_8LS(0xdc000000, s, a, r, d)
|
||
|
|
|
||
|
|
#endif /* _SELFTESTS_POWERPC_INSTRUCTIONS_H */
|