d63aeb3b7e
Some registers are defined to have immutable bits, this commit will implement that behavior. Signed-off-by: Marco Liebel <quic_mliebel@quicinc.com> Reviewed-by: Taylor Simpson <tsimpson@quicinc.com> Signed-off-by: Taylor Simpson <tsimpson@quicinc.com> Message-Id: <20230105102349.2181856-1-quic_mliebel@quicinc.com>
153 lines
4.5 KiB
C
153 lines
4.5 KiB
C
|
|
/*
|
|
* Copyright(c) 2022 Qualcomm Innovation Center, Inc. All Rights Reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdint.h>
|
|
|
|
static int err;
|
|
|
|
#define check(N, EXPECT) \
|
|
do { \
|
|
uint64_t value = N; \
|
|
uint64_t expect = EXPECT; \
|
|
if (value != EXPECT) { \
|
|
printf("ERROR: \"%s\" 0x%04llx != 0x%04llx at %s:%d\n", #N, value, \
|
|
expect, __FILE__, __LINE__); \
|
|
err++; \
|
|
} \
|
|
} while (0)
|
|
|
|
#define check_ne(N, EXPECT) \
|
|
do { \
|
|
uint64_t value = N; \
|
|
uint64_t expect = EXPECT; \
|
|
if (value == EXPECT) { \
|
|
printf("ERROR: \"%s\" 0x%04llx == 0x%04llx at %s:%d\n", #N, value, \
|
|
expect, __FILE__, __LINE__); \
|
|
err++; \
|
|
} \
|
|
} while (0)
|
|
|
|
#define WRITE_REG_NOCLOBBER(output, reg_name, input) \
|
|
asm volatile(reg_name " = %1\n\t" \
|
|
"%0 = " reg_name "\n\t" \
|
|
: "=r"(output) \
|
|
: "r"(input) \
|
|
: );
|
|
|
|
#define WRITE_REG_ENCODED(output, reg_name, input, encoding) \
|
|
asm volatile("r0 = %1\n\t" \
|
|
encoding "\n\t" \
|
|
"%0 = " reg_name "\n\t" \
|
|
: "=r"(output) \
|
|
: "r"(input) \
|
|
: "r0");
|
|
|
|
#define WRITE_REG_PAIR_ENCODED(output, reg_name, input, encoding) \
|
|
asm volatile("r1:0 = %1\n\t" \
|
|
encoding "\n\t" \
|
|
"%0 = " reg_name "\n\t" \
|
|
: "=r"(output) \
|
|
: "r"(input) \
|
|
: "r1:0");
|
|
|
|
/*
|
|
* Instruction word: { pc = r0 }
|
|
*
|
|
* This instruction is barred by the assembler.
|
|
*
|
|
* 3 2 1
|
|
* 1 0 9 8 7 6 5 4 3 2 1 0 9 8 7 6 5 4 3 2 1 0 9 8 7 6 5 4 3 2 1 0
|
|
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
|
|
* | Opc[A2_tfrrcr] | Src[R0] |P P| | C9/PC |
|
|
* +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
|
|
*/
|
|
#define PC_EQ_R0 ".word 0x6220c009"
|
|
#define C9_8_EQ_R1_0 ".word 0x6320c008"
|
|
|
|
static inline void write_control_registers(void)
|
|
{
|
|
uint32_t result = 0;
|
|
|
|
WRITE_REG_NOCLOBBER(result, "usr", 0xffffffff);
|
|
check(result, 0x3ecfff3f);
|
|
|
|
WRITE_REG_NOCLOBBER(result, "gp", 0xffffffff);
|
|
check(result, 0xffffffc0);
|
|
|
|
WRITE_REG_NOCLOBBER(result, "upcyclelo", 0xffffffff);
|
|
check(result, 0x00000000);
|
|
|
|
WRITE_REG_NOCLOBBER(result, "upcyclehi", 0xffffffff);
|
|
check(result, 0x00000000);
|
|
|
|
WRITE_REG_NOCLOBBER(result, "utimerlo", 0xffffffff);
|
|
check(result, 0x00000000);
|
|
|
|
WRITE_REG_NOCLOBBER(result, "utimerhi", 0xffffffff);
|
|
check(result, 0x00000000);
|
|
|
|
/*
|
|
* PC is special. Setting it to these values
|
|
* should cause a catastrophic failure.
|
|
*/
|
|
WRITE_REG_ENCODED(result, "pc", 0x00000000, PC_EQ_R0);
|
|
check_ne(result, 0x00000000);
|
|
|
|
WRITE_REG_ENCODED(result, "pc", 0x00000001, PC_EQ_R0);
|
|
check_ne(result, 0x00000001);
|
|
|
|
WRITE_REG_ENCODED(result, "pc", 0xffffffff, PC_EQ_R0);
|
|
check_ne(result, 0xffffffff);
|
|
}
|
|
|
|
static inline void write_control_register_pairs(void)
|
|
{
|
|
uint64_t result = 0;
|
|
|
|
WRITE_REG_NOCLOBBER(result, "c11:10", 0xffffffffffffffff);
|
|
check(result, 0xffffffc0ffffffff);
|
|
|
|
WRITE_REG_NOCLOBBER(result, "c15:14", 0xffffffffffffffff);
|
|
check(result, 0x0000000000000000);
|
|
|
|
WRITE_REG_NOCLOBBER(result, "c31:30", 0xffffffffffffffff);
|
|
check(result, 0x0000000000000000);
|
|
|
|
WRITE_REG_PAIR_ENCODED(result, "c9:8", (uint64_t) 0x0000000000000000,
|
|
C9_8_EQ_R1_0);
|
|
check_ne(result, 0x000000000000000);
|
|
|
|
WRITE_REG_PAIR_ENCODED(result, "c9:8", 0x0000000100000000, C9_8_EQ_R1_0);
|
|
check_ne(result, 0x0000000100000000);
|
|
|
|
WRITE_REG_PAIR_ENCODED(result, "c9:8", 0xffffffffffffffff, C9_8_EQ_R1_0);
|
|
check_ne(result, 0xffffffffffffffff);
|
|
}
|
|
|
|
int main()
|
|
{
|
|
err = 0;
|
|
|
|
write_control_registers();
|
|
write_control_register_pairs();
|
|
|
|
puts(err ? "FAIL" : "PASS");
|
|
return err;
|
|
}
|