|
@@ -0,0 +1,717 @@
|
|
|
|
+/*
|
|
|
|
+ * Non-crypto strength model of the True Random Number Generator
|
|
|
|
+ * in the AMD/Xilinx Versal device family.
|
|
|
|
+ *
|
|
|
|
+ * Copyright (c) 2017-2020 Xilinx Inc.
|
|
|
|
+ * Copyright (c) 2023 Advanced Micro Devices, Inc.
|
|
|
|
+ *
|
|
|
|
+ * Written by Edgar E. Iglesias <edgar.iglesias@xilinx.com>
|
|
|
|
+ *
|
|
|
|
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
|
|
+ * of this software and associated documentation files (the "Software"), to deal
|
|
|
|
+ * in the Software without restriction, including without limitation the rights
|
|
|
|
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
|
|
+ * copies of the Software, and to permit persons to whom the Software is
|
|
|
|
+ * furnished to do so, subject to the following conditions:
|
|
|
|
+ *
|
|
|
|
+ * The above copyright notice and this permission notice shall be included in
|
|
|
|
+ * all copies or substantial portions of the Software.
|
|
|
|
+ *
|
|
|
|
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
|
|
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
|
|
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
|
|
+ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
|
|
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
|
|
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
|
|
+ * THE SOFTWARE.
|
|
|
|
+ */
|
|
|
|
+#include "qemu/osdep.h"
|
|
|
|
+#include "hw/misc/xlnx-versal-trng.h"
|
|
|
|
+
|
|
|
|
+#include "qemu/bitops.h"
|
|
|
|
+#include "qemu/log.h"
|
|
|
|
+#include "qemu/error-report.h"
|
|
|
|
+#include "qemu/guest-random.h"
|
|
|
|
+#include "qemu/timer.h"
|
|
|
|
+#include "qapi/visitor.h"
|
|
|
|
+#include "migration/vmstate.h"
|
|
|
|
+#include "hw/qdev-properties.h"
|
|
|
|
+
|
|
|
|
+#ifndef XLNX_VERSAL_TRNG_ERR_DEBUG
|
|
|
|
+#define XLNX_VERSAL_TRNG_ERR_DEBUG 0
|
|
|
|
+#endif
|
|
|
|
+
|
|
|
|
+REG32(INT_CTRL, 0x0)
|
|
|
|
+ FIELD(INT_CTRL, CERTF_RST, 5, 1)
|
|
|
|
+ FIELD(INT_CTRL, DTF_RST, 4, 1)
|
|
|
|
+ FIELD(INT_CTRL, DONE_RST, 3, 1)
|
|
|
|
+ FIELD(INT_CTRL, CERTF_EN, 2, 1)
|
|
|
|
+ FIELD(INT_CTRL, DTF_EN, 1, 1)
|
|
|
|
+ FIELD(INT_CTRL, DONE_EN, 0, 1)
|
|
|
|
+REG32(STATUS, 0x4)
|
|
|
|
+ FIELD(STATUS, QCNT, 9, 3)
|
|
|
|
+ FIELD(STATUS, EAT, 4, 5)
|
|
|
|
+ FIELD(STATUS, CERTF, 3, 1)
|
|
|
|
+ FIELD(STATUS, DTF, 1, 1)
|
|
|
|
+ FIELD(STATUS, DONE, 0, 1)
|
|
|
|
+REG32(CTRL, 0x8)
|
|
|
|
+ FIELD(CTRL, PERSODISABLE, 10, 1)
|
|
|
|
+ FIELD(CTRL, SINGLEGENMODE, 9, 1)
|
|
|
|
+ FIELD(CTRL, EUMODE, 8, 1)
|
|
|
|
+ FIELD(CTRL, PRNGMODE, 7, 1)
|
|
|
|
+ FIELD(CTRL, TSTMODE, 6, 1)
|
|
|
|
+ FIELD(CTRL, PRNGSTART, 5, 1)
|
|
|
|
+ FIELD(CTRL, EATAU, 4, 1)
|
|
|
|
+ FIELD(CTRL, PRNGXS, 3, 1)
|
|
|
|
+ FIELD(CTRL, TRSSEN, 2, 1)
|
|
|
|
+ FIELD(CTRL, QERTUEN, 1, 1)
|
|
|
|
+ FIELD(CTRL, PRNGSRST, 0, 1)
|
|
|
|
+REG32(CTRL_2, 0xc)
|
|
|
|
+ FIELD(CTRL_2, REPCOUNTTESTCUTOFF, 8, 9)
|
|
|
|
+ FIELD(CTRL_2, RESERVED_7_5, 5, 3)
|
|
|
|
+ FIELD(CTRL_2, DIT, 0, 5)
|
|
|
|
+REG32(CTRL_3, 0x10)
|
|
|
|
+ FIELD(CTRL_3, ADAPTPROPTESTCUTOFF, 8, 10)
|
|
|
|
+ FIELD(CTRL_3, DLEN, 0, 8)
|
|
|
|
+REG32(CTRL_4, 0x14)
|
|
|
|
+ FIELD(CTRL_4, SINGLEBITRAW, 0, 1)
|
|
|
|
+REG32(EXT_SEED_0, 0x40)
|
|
|
|
+REG32(EXT_SEED_1, 0x44)
|
|
|
|
+REG32(EXT_SEED_2, 0x48)
|
|
|
|
+REG32(EXT_SEED_3, 0x4c)
|
|
|
|
+REG32(EXT_SEED_4, 0x50)
|
|
|
|
+REG32(EXT_SEED_5, 0x54)
|
|
|
|
+REG32(EXT_SEED_6, 0x58)
|
|
|
|
+REG32(EXT_SEED_7, 0x5c)
|
|
|
|
+REG32(EXT_SEED_8, 0x60)
|
|
|
|
+REG32(EXT_SEED_9, 0x64)
|
|
|
|
+REG32(EXT_SEED_10, 0x68)
|
|
|
|
+REG32(EXT_SEED_11, 0x6c)
|
|
|
|
+REG32(PER_STRNG_0, 0x80)
|
|
|
|
+REG32(PER_STRNG_1, 0x84)
|
|
|
|
+REG32(PER_STRNG_2, 0x88)
|
|
|
|
+REG32(PER_STRNG_3, 0x8c)
|
|
|
|
+REG32(PER_STRNG_4, 0x90)
|
|
|
|
+REG32(PER_STRNG_5, 0x94)
|
|
|
|
+REG32(PER_STRNG_6, 0x98)
|
|
|
|
+REG32(PER_STRNG_7, 0x9c)
|
|
|
|
+REG32(PER_STRNG_8, 0xa0)
|
|
|
|
+REG32(PER_STRNG_9, 0xa4)
|
|
|
|
+REG32(PER_STRNG_10, 0xa8)
|
|
|
|
+REG32(PER_STRNG_11, 0xac)
|
|
|
|
+REG32(CORE_OUTPUT, 0xc0)
|
|
|
|
+REG32(RESET, 0xd0)
|
|
|
|
+ FIELD(RESET, VAL, 0, 1)
|
|
|
|
+REG32(OSC_EN, 0xd4)
|
|
|
|
+ FIELD(OSC_EN, VAL, 0, 1)
|
|
|
|
+REG32(TRNG_ISR, 0xe0)
|
|
|
|
+ FIELD(TRNG_ISR, SLVERR, 1, 1)
|
|
|
|
+ FIELD(TRNG_ISR, CORE_INT, 0, 1)
|
|
|
|
+REG32(TRNG_IMR, 0xe4)
|
|
|
|
+ FIELD(TRNG_IMR, SLVERR, 1, 1)
|
|
|
|
+ FIELD(TRNG_IMR, CORE_INT, 0, 1)
|
|
|
|
+REG32(TRNG_IER, 0xe8)
|
|
|
|
+ FIELD(TRNG_IER, SLVERR, 1, 1)
|
|
|
|
+ FIELD(TRNG_IER, CORE_INT, 0, 1)
|
|
|
|
+REG32(TRNG_IDR, 0xec)
|
|
|
|
+ FIELD(TRNG_IDR, SLVERR, 1, 1)
|
|
|
|
+ FIELD(TRNG_IDR, CORE_INT, 0, 1)
|
|
|
|
+REG32(SLV_ERR_CTRL, 0xf0)
|
|
|
|
+ FIELD(SLV_ERR_CTRL, ENABLE, 0, 1)
|
|
|
|
+
|
|
|
|
+#define R_MAX (R_SLV_ERR_CTRL + 1)
|
|
|
|
+
|
|
|
|
+QEMU_BUILD_BUG_ON(R_MAX * 4 != sizeof_field(XlnxVersalTRng, regs));
|
|
|
|
+
|
|
|
|
+#define TRNG_GUEST_ERROR(D, FMT, ...) \
|
|
|
|
+ do { \
|
|
|
|
+ g_autofree char *p = object_get_canonical_path(OBJECT(D)); \
|
|
|
|
+ qemu_log_mask(LOG_GUEST_ERROR, "%s: " FMT, p, ## __VA_ARGS__); \
|
|
|
|
+ } while (0)
|
|
|
|
+
|
|
|
|
+#define TRNG_WARN(D, FMT, ...) \
|
|
|
|
+ do { \
|
|
|
|
+ g_autofree char *p = object_get_canonical_path(OBJECT(D)); \
|
|
|
|
+ warn_report("%s: " FMT, p, ## __VA_ARGS__); \
|
|
|
|
+ } while (0)
|
|
|
|
+
|
|
|
|
+static bool trng_older_than_v2(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ return s->hw_version < 0x0200;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static bool trng_in_reset(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ if (ARRAY_FIELD_EX32(s->regs, RESET, VAL)) {
|
|
|
|
+ return true;
|
|
|
|
+ }
|
|
|
|
+ if (ARRAY_FIELD_EX32(s->regs, CTRL, PRNGSRST)) {
|
|
|
|
+ return true;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return false;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static bool trng_test_enabled(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ return ARRAY_FIELD_EX32(s->regs, CTRL, TSTMODE);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static bool trng_trss_enabled(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ if (trng_in_reset(s)) {
|
|
|
|
+ return false;
|
|
|
|
+ }
|
|
|
|
+ if (!ARRAY_FIELD_EX32(s->regs, CTRL, TRSSEN)) {
|
|
|
|
+ return false;
|
|
|
|
+ }
|
|
|
|
+ if (!ARRAY_FIELD_EX32(s->regs, OSC_EN, VAL)) {
|
|
|
|
+ return false;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return true;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_seed_128(uint32_t *seed, uint64_t h00, uint64_t h64)
|
|
|
|
+{
|
|
|
|
+ seed[0] = extract64(h00, 0, 32);
|
|
|
|
+ seed[1] = extract64(h00, 32, 32);
|
|
|
|
+ seed[2] = extract64(h64, 0, 32);
|
|
|
|
+ seed[3] = extract64(h64, 32, 32);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_reseed(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ bool ext_seed = ARRAY_FIELD_EX32(s->regs, CTRL, PRNGXS);
|
|
|
|
+ bool pers_disabled = ARRAY_FIELD_EX32(s->regs, CTRL, PERSODISABLE);
|
|
|
|
+
|
|
|
|
+ enum {
|
|
|
|
+ U384_U8 = 384 / 8,
|
|
|
|
+ U384_U32 = 384 / 32,
|
|
|
|
+ };
|
|
|
|
+
|
|
|
|
+ /*
|
|
|
|
+ * Maximum seed length is len(personalized string) + len(ext seed).
|
|
|
|
+ *
|
|
|
|
+ * g_rand_set_seed_array() takes array of uint32 in host endian.
|
|
|
|
+ */
|
|
|
|
+ guint32 gs[U384_U32 * 2], *seed = &gs[U384_U32];
|
|
|
|
+
|
|
|
|
+ /*
|
|
|
|
+ * A disabled personalized string is the same as
|
|
|
|
+ * a string with all zeros.
|
|
|
|
+ *
|
|
|
|
+ * The device's hardware spec defines 3 modes (all selectable
|
|
|
|
+ * by guest at will and at anytime):
|
|
|
|
+ * 1) External seeding
|
|
|
|
+ * This is a PRNG mode, in which the produced sequence shall
|
|
|
|
+ * be reproducible if reseeded by the same 384-bit seed, as
|
|
|
|
+ * supplied by guest software.
|
|
|
|
+ * 2) Test seeding
|
|
|
|
+ * This is a PRNG mode, in which the produced sequence shall
|
|
|
|
+ * be reproducible if reseeded by a 128-bit test seed, as
|
|
|
|
+ * supplied by guest software.
|
|
|
|
+ * 3) Truly-random seeding
|
|
|
|
+ * This is the TRNG mode, in which the produced sequence is
|
|
|
|
+ * periodically reseeded by a crypto-strength entropy source.
|
|
|
|
+ *
|
|
|
|
+ * To assist debugging of certain classes of software defects,
|
|
|
|
+ * this QEMU model implements a 4th mode,
|
|
|
|
+ * 4) Forced PRNG
|
|
|
|
+ * When in this mode, a reproducible sequence is generated
|
|
|
|
+ * if software has selected the TRNG mode (mode 2).
|
|
|
|
+ *
|
|
|
|
+ * This emulation-only mode can only be selected by setting
|
|
|
|
+ * the uint64 property 'forced-prng' to a non-zero value.
|
|
|
|
+ * Guest software cannot select this mode.
|
|
|
|
+ */
|
|
|
|
+ memset(gs, 0, sizeof(gs));
|
|
|
|
+
|
|
|
|
+ if (!pers_disabled) {
|
|
|
|
+ memcpy(gs, &s->regs[R_PER_STRNG_0], U384_U8);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (ext_seed) {
|
|
|
|
+ memcpy(seed, &s->regs[R_EXT_SEED_0], U384_U8);
|
|
|
|
+ } else if (trng_test_enabled(s)) {
|
|
|
|
+ trng_seed_128(seed, s->tst_seed[0], s->tst_seed[1]);
|
|
|
|
+ } else if (s->forced_prng_seed) {
|
|
|
|
+ s->forced_prng_count++;
|
|
|
|
+ trng_seed_128(seed, s->forced_prng_count, s->forced_prng_seed);
|
|
|
|
+ } else {
|
|
|
|
+ qemu_guest_getrandom_nofail(seed, U384_U8);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ g_rand_set_seed_array(s->prng, gs, ARRAY_SIZE(gs));
|
|
|
|
+
|
|
|
|
+ s->rand_count = 0;
|
|
|
|
+ s->rand_reseed = 1ULL << 48;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_regen(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ if (s->rand_reseed == 0) {
|
|
|
|
+ TRNG_GUEST_ERROR(s, "Too many generations without a reseed");
|
|
|
|
+ trng_reseed(s);
|
|
|
|
+ }
|
|
|
|
+ s->rand_reseed--;
|
|
|
|
+
|
|
|
|
+ /*
|
|
|
|
+ * In real hardware, each regen creates 256 bits, but QCNT
|
|
|
|
+ * reports a max of 4.
|
|
|
|
+ */
|
|
|
|
+ ARRAY_FIELD_DP32(s->regs, STATUS, QCNT, 4);
|
|
|
|
+ s->rand_count = 256 / 32;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static uint32_t trng_rdout(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ assert(s->rand_count);
|
|
|
|
+
|
|
|
|
+ s->rand_count--;
|
|
|
|
+ if (s->rand_count < 4) {
|
|
|
|
+ ARRAY_FIELD_DP32(s->regs, STATUS, QCNT, s->rand_count);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return g_rand_int(s->prng);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_irq_update(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ bool pending = s->regs[R_TRNG_ISR] & ~s->regs[R_TRNG_IMR];
|
|
|
|
+ qemu_set_irq(s->irq, pending);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_isr_postw(RegisterInfo *reg, uint64_t val64)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg->opaque);
|
|
|
|
+ trng_irq_update(s);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static uint64_t trng_ier_prew(RegisterInfo *reg, uint64_t val64)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg->opaque);
|
|
|
|
+ uint32_t val = val64;
|
|
|
|
+
|
|
|
|
+ s->regs[R_TRNG_IMR] &= ~val;
|
|
|
|
+ trng_irq_update(s);
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static uint64_t trng_idr_prew(RegisterInfo *reg, uint64_t val64)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg->opaque);
|
|
|
|
+ uint32_t val = val64;
|
|
|
|
+
|
|
|
|
+ s->regs[R_TRNG_IMR] |= val;
|
|
|
|
+ trng_irq_update(s);
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_core_int_update(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ bool pending = false;
|
|
|
|
+ uint32_t st = s->regs[R_STATUS];
|
|
|
|
+ uint32_t en = s->regs[R_INT_CTRL];
|
|
|
|
+
|
|
|
|
+ if (FIELD_EX32(st, STATUS, CERTF) && FIELD_EX32(en, INT_CTRL, CERTF_EN)) {
|
|
|
|
+ pending = true;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (FIELD_EX32(st, STATUS, DTF) && FIELD_EX32(en, INT_CTRL, DTF_EN)) {
|
|
|
|
+ pending = true;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (FIELD_EX32(st, STATUS, DONE) && FIELD_EX32(en, INT_CTRL, DONE_EN)) {
|
|
|
|
+ pending = true;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ ARRAY_FIELD_DP32(s->regs, TRNG_ISR, CORE_INT, pending);
|
|
|
|
+ trng_irq_update(s);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_int_ctrl_postw(RegisterInfo *reg, uint64_t val64)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg->opaque);
|
|
|
|
+ uint32_t v32 = val64;
|
|
|
|
+ uint32_t clr_mask = 0;
|
|
|
|
+
|
|
|
|
+ if (FIELD_EX32(v32, INT_CTRL, CERTF_RST)) {
|
|
|
|
+ clr_mask |= R_STATUS_CERTF_MASK;
|
|
|
|
+ }
|
|
|
|
+ if (FIELD_EX32(v32, INT_CTRL, DTF_RST)) {
|
|
|
|
+ clr_mask |= R_STATUS_DTF_MASK;
|
|
|
|
+ }
|
|
|
|
+ if (FIELD_EX32(v32, INT_CTRL, DONE_RST)) {
|
|
|
|
+ clr_mask |= R_STATUS_DONE_MASK;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ s->regs[R_STATUS] &= ~clr_mask;
|
|
|
|
+ trng_core_int_update(s);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_done(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ ARRAY_FIELD_DP32(s->regs, STATUS, DONE, true);
|
|
|
|
+ trng_core_int_update(s);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_fault_event_set(XlnxVersalTRng *s, uint32_t events)
|
|
|
|
+{
|
|
|
|
+ bool pending = false;
|
|
|
|
+
|
|
|
|
+ /* Disabled TRSS cannot generate any fault event */
|
|
|
|
+ if (!trng_trss_enabled(s)) {
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (FIELD_EX32(events, STATUS, CERTF)) {
|
|
|
|
+ /* In older version, ERTU must be enabled explicitly to get CERTF */
|
|
|
|
+ if (trng_older_than_v2(s) &&
|
|
|
|
+ !ARRAY_FIELD_EX32(s->regs, CTRL, QERTUEN)) {
|
|
|
|
+ TRNG_WARN(s, "CERTF injection ignored: ERTU disabled");
|
|
|
|
+ } else {
|
|
|
|
+ ARRAY_FIELD_DP32(s->regs, STATUS, CERTF, true);
|
|
|
|
+ pending = true;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (FIELD_EX32(events, STATUS, DTF)) {
|
|
|
|
+ ARRAY_FIELD_DP32(s->regs, STATUS, DTF, true);
|
|
|
|
+ pending = true;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (pending) {
|
|
|
|
+ trng_core_int_update(s);
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_soft_reset(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ s->rand_count = 0;
|
|
|
|
+ s->regs[R_STATUS] = 0;
|
|
|
|
+
|
|
|
|
+ ARRAY_FIELD_DP32(s->regs, TRNG_ISR, CORE_INT, 0);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_ctrl_postw(RegisterInfo *reg, uint64_t val64)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg->opaque);
|
|
|
|
+
|
|
|
|
+ if (trng_in_reset(s)) {
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (FIELD_EX32(val64, CTRL, PRNGSRST)) {
|
|
|
|
+ trng_soft_reset(s);
|
|
|
|
+ trng_irq_update(s);
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (!FIELD_EX32(val64, CTRL, PRNGSTART)) {
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (FIELD_EX32(val64, CTRL, PRNGMODE)) {
|
|
|
|
+ trng_regen(s);
|
|
|
|
+ } else {
|
|
|
|
+ trng_reseed(s);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ trng_done(s);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_ctrl4_postw(RegisterInfo *reg, uint64_t val64)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg->opaque);
|
|
|
|
+
|
|
|
|
+ /* Only applies to test mode with TRSS enabled */
|
|
|
|
+ if (!trng_test_enabled(s) || !trng_trss_enabled(s)) {
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* Shift in a single bit. */
|
|
|
|
+ s->tst_seed[1] <<= 1;
|
|
|
|
+ s->tst_seed[1] |= s->tst_seed[0] >> 63;
|
|
|
|
+ s->tst_seed[0] <<= 1;
|
|
|
|
+ s->tst_seed[0] |= val64 & 1;
|
|
|
|
+
|
|
|
|
+ trng_reseed(s);
|
|
|
|
+ trng_regen(s);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static uint64_t trng_core_out_postr(RegisterInfo *reg, uint64_t val)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg->opaque);
|
|
|
|
+ bool oneshot = ARRAY_FIELD_EX32(s->regs, CTRL, SINGLEGENMODE);
|
|
|
|
+ bool start = ARRAY_FIELD_EX32(s->regs, CTRL, PRNGSTART);
|
|
|
|
+ uint32_t r = 0xbad;
|
|
|
|
+
|
|
|
|
+ if (trng_in_reset(s)) {
|
|
|
|
+ TRNG_GUEST_ERROR(s, "Reading random number while in reset!");
|
|
|
|
+ return r;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (s->rand_count == 0) {
|
|
|
|
+ TRNG_GUEST_ERROR(s, "Reading random number when unavailable!");
|
|
|
|
+ return r;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ r = trng_rdout(s);
|
|
|
|
+
|
|
|
|
+ /* Automatic mode regenerates when half the output reg is empty. */
|
|
|
|
+ if (!oneshot && start && s->rand_count <= 3) {
|
|
|
|
+ trng_regen(s);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return r;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_reset(XlnxVersalTRng *s)
|
|
|
|
+{
|
|
|
|
+ unsigned int i;
|
|
|
|
+
|
|
|
|
+ s->forced_prng_count = 0;
|
|
|
|
+
|
|
|
|
+ for (i = 0; i < ARRAY_SIZE(s->regs_info); ++i) {
|
|
|
|
+ register_reset(&s->regs_info[i]);
|
|
|
|
+ }
|
|
|
|
+ trng_soft_reset(s);
|
|
|
|
+ trng_irq_update(s);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static uint64_t trng_reset_prew(RegisterInfo *reg, uint64_t val64)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg->opaque);
|
|
|
|
+
|
|
|
|
+ if (!ARRAY_FIELD_EX32(s->regs, RESET, VAL) &&
|
|
|
|
+ FIELD_EX32(val64, RESET, VAL)) {
|
|
|
|
+ trng_reset(s);
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return val64;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static uint64_t trng_register_read(void *opaque, hwaddr addr, unsigned size)
|
|
|
|
+{
|
|
|
|
+ /*
|
|
|
|
+ * Guest provided seed and personalized strings cannot be
|
|
|
|
+ * read back, and read attempts return value of A_STATUS.
|
|
|
|
+ */
|
|
|
|
+ switch (addr) {
|
|
|
|
+ case A_EXT_SEED_0 ... A_PER_STRNG_11:
|
|
|
|
+ addr = A_STATUS;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ return register_read_memory(opaque, addr, size);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_register_write(void *opaque, hwaddr addr,
|
|
|
|
+ uint64_t value, unsigned size)
|
|
|
|
+{
|
|
|
|
+ RegisterInfoArray *reg_array = opaque;
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(reg_array->r[0]->opaque);
|
|
|
|
+
|
|
|
|
+ if (trng_older_than_v2(s)) {
|
|
|
|
+ switch (addr) {
|
|
|
|
+ case A_CTRL:
|
|
|
|
+ value = FIELD_DP64(value, CTRL, PERSODISABLE, 0);
|
|
|
|
+ value = FIELD_DP64(value, CTRL, SINGLEGENMODE, 0);
|
|
|
|
+ break;
|
|
|
|
+ case A_CTRL_2:
|
|
|
|
+ case A_CTRL_3:
|
|
|
|
+ case A_CTRL_4:
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+ } else {
|
|
|
|
+ switch (addr) {
|
|
|
|
+ case A_CTRL:
|
|
|
|
+ value = FIELD_DP64(value, CTRL, EATAU, 0);
|
|
|
|
+ value = FIELD_DP64(value, CTRL, QERTUEN, 0);
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ register_write_memory(opaque, addr, value, size);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static RegisterAccessInfo trng_regs_info[] = {
|
|
|
|
+ { .name = "INT_CTRL", .addr = A_INT_CTRL,
|
|
|
|
+ .post_write = trng_int_ctrl_postw,
|
|
|
|
+ },{ .name = "STATUS", .addr = A_STATUS,
|
|
|
|
+ .ro = 0xfff,
|
|
|
|
+ },{ .name = "CTRL", .addr = A_CTRL,
|
|
|
|
+ .post_write = trng_ctrl_postw,
|
|
|
|
+ },{ .name = "CTRL_2", .addr = A_CTRL_2,
|
|
|
|
+ .reset = 0x210c,
|
|
|
|
+ },{ .name = "CTRL_3", .addr = A_CTRL_3,
|
|
|
|
+ .reset = 0x26f09,
|
|
|
|
+ },{ .name = "CTRL_4", .addr = A_CTRL_4,
|
|
|
|
+ .post_write = trng_ctrl4_postw,
|
|
|
|
+ },{ .name = "EXT_SEED_0", .addr = A_EXT_SEED_0,
|
|
|
|
+ },{ .name = "EXT_SEED_1", .addr = A_EXT_SEED_1,
|
|
|
|
+ },{ .name = "EXT_SEED_2", .addr = A_EXT_SEED_2,
|
|
|
|
+ },{ .name = "EXT_SEED_3", .addr = A_EXT_SEED_3,
|
|
|
|
+ },{ .name = "EXT_SEED_4", .addr = A_EXT_SEED_4,
|
|
|
|
+ },{ .name = "EXT_SEED_5", .addr = A_EXT_SEED_5,
|
|
|
|
+ },{ .name = "EXT_SEED_6", .addr = A_EXT_SEED_6,
|
|
|
|
+ },{ .name = "EXT_SEED_7", .addr = A_EXT_SEED_7,
|
|
|
|
+ },{ .name = "EXT_SEED_8", .addr = A_EXT_SEED_8,
|
|
|
|
+ },{ .name = "EXT_SEED_9", .addr = A_EXT_SEED_9,
|
|
|
|
+ },{ .name = "EXT_SEED_10", .addr = A_EXT_SEED_10,
|
|
|
|
+ },{ .name = "EXT_SEED_11", .addr = A_EXT_SEED_11,
|
|
|
|
+ },{ .name = "PER_STRNG_0", .addr = A_PER_STRNG_0,
|
|
|
|
+ },{ .name = "PER_STRNG_1", .addr = A_PER_STRNG_1,
|
|
|
|
+ },{ .name = "PER_STRNG_2", .addr = A_PER_STRNG_2,
|
|
|
|
+ },{ .name = "PER_STRNG_3", .addr = A_PER_STRNG_3,
|
|
|
|
+ },{ .name = "PER_STRNG_4", .addr = A_PER_STRNG_4,
|
|
|
|
+ },{ .name = "PER_STRNG_5", .addr = A_PER_STRNG_5,
|
|
|
|
+ },{ .name = "PER_STRNG_6", .addr = A_PER_STRNG_6,
|
|
|
|
+ },{ .name = "PER_STRNG_7", .addr = A_PER_STRNG_7,
|
|
|
|
+ },{ .name = "PER_STRNG_8", .addr = A_PER_STRNG_8,
|
|
|
|
+ },{ .name = "PER_STRNG_9", .addr = A_PER_STRNG_9,
|
|
|
|
+ },{ .name = "PER_STRNG_10", .addr = A_PER_STRNG_10,
|
|
|
|
+ },{ .name = "PER_STRNG_11", .addr = A_PER_STRNG_11,
|
|
|
|
+ },{ .name = "CORE_OUTPUT", .addr = A_CORE_OUTPUT,
|
|
|
|
+ .ro = 0xffffffff,
|
|
|
|
+ .post_read = trng_core_out_postr,
|
|
|
|
+ },{ .name = "RESET", .addr = A_RESET,
|
|
|
|
+ .reset = 0x1,
|
|
|
|
+ .pre_write = trng_reset_prew,
|
|
|
|
+ },{ .name = "OSC_EN", .addr = A_OSC_EN,
|
|
|
|
+ },{ .name = "TRNG_ISR", .addr = A_TRNG_ISR,
|
|
|
|
+ .w1c = 0x3,
|
|
|
|
+ .post_write = trng_isr_postw,
|
|
|
|
+ },{ .name = "TRNG_IMR", .addr = A_TRNG_IMR,
|
|
|
|
+ .reset = 0x3,
|
|
|
|
+ .ro = 0x3,
|
|
|
|
+ },{ .name = "TRNG_IER", .addr = A_TRNG_IER,
|
|
|
|
+ .pre_write = trng_ier_prew,
|
|
|
|
+ },{ .name = "TRNG_IDR", .addr = A_TRNG_IDR,
|
|
|
|
+ .pre_write = trng_idr_prew,
|
|
|
|
+ },{ .name = "SLV_ERR_CTRL", .addr = A_SLV_ERR_CTRL,
|
|
|
|
+ }
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static const MemoryRegionOps trng_ops = {
|
|
|
|
+ .read = trng_register_read,
|
|
|
|
+ .write = trng_register_write,
|
|
|
|
+ .endianness = DEVICE_LITTLE_ENDIAN,
|
|
|
|
+ .valid = {
|
|
|
|
+ .min_access_size = 4,
|
|
|
|
+ .max_access_size = 4,
|
|
|
|
+ },
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static void trng_init(Object *obj)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(obj);
|
|
|
|
+ SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
|
|
|
|
+ RegisterInfoArray *reg_array;
|
|
|
|
+
|
|
|
|
+ reg_array =
|
|
|
|
+ register_init_block32(DEVICE(obj), trng_regs_info,
|
|
|
|
+ ARRAY_SIZE(trng_regs_info),
|
|
|
|
+ s->regs_info, s->regs,
|
|
|
|
+ &trng_ops,
|
|
|
|
+ XLNX_VERSAL_TRNG_ERR_DEBUG,
|
|
|
|
+ R_MAX * 4);
|
|
|
|
+
|
|
|
|
+ sysbus_init_mmio(sbd, ®_array->mem);
|
|
|
|
+ sysbus_init_irq(sbd, &s->irq);
|
|
|
|
+
|
|
|
|
+ s->prng = g_rand_new();
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_unrealize(DeviceState *dev)
|
|
|
|
+{
|
|
|
|
+ XlnxVersalTRng *s = XLNX_VERSAL_TRNG(dev);
|
|
|
|
+
|
|
|
|
+ g_rand_free(s->prng);
|
|
|
|
+ s->prng = NULL;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_reset_hold(Object *obj)
|
|
|
|
+{
|
|
|
|
+ trng_reset(XLNX_VERSAL_TRNG(obj));
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void trng_prop_fault_event_set(Object *obj, Visitor *v,
|
|
|
|
+ const char *name, void *opaque,
|
|
|
|
+ Error **errp)
|
|
|
|
+{
|
|
|
|
+ Property *prop = opaque;
|
|
|
|
+ uint32_t *events = object_field_prop_ptr(obj, prop);
|
|
|
|
+
|
|
|
|
+ visit_type_uint32(v, name, events, errp);
|
|
|
|
+ if (*errp) {
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ trng_fault_event_set(XLNX_VERSAL_TRNG(obj), *events);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static const PropertyInfo trng_prop_fault_events = {
|
|
|
|
+ .name = "uint32:bits",
|
|
|
|
+ .description = "Set to trigger TRNG fault events",
|
|
|
|
+ .set = trng_prop_fault_event_set,
|
|
|
|
+ .realized_set_allowed = true,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static PropertyInfo trng_prop_uint64; /* to extend qdev_prop_uint64 */
|
|
|
|
+
|
|
|
|
+static Property trng_props[] = {
|
|
|
|
+ DEFINE_PROP_UINT64("forced-prng", XlnxVersalTRng, forced_prng_seed, 0),
|
|
|
|
+ DEFINE_PROP_UINT32("hw-version", XlnxVersalTRng, hw_version, 0x0200),
|
|
|
|
+ DEFINE_PROP("fips-fault-events", XlnxVersalTRng, forced_faults,
|
|
|
|
+ trng_prop_fault_events, uint32_t),
|
|
|
|
+
|
|
|
|
+ DEFINE_PROP_END_OF_LIST(),
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static const VMStateDescription vmstate_trng = {
|
|
|
|
+ .name = TYPE_XLNX_VERSAL_TRNG,
|
|
|
|
+ .version_id = 1,
|
|
|
|
+ .minimum_version_id = 1,
|
|
|
|
+ .fields = (VMStateField[]) {
|
|
|
|
+ VMSTATE_UINT32(rand_count, XlnxVersalTRng),
|
|
|
|
+ VMSTATE_UINT64(rand_reseed, XlnxVersalTRng),
|
|
|
|
+ VMSTATE_UINT64(forced_prng_count, XlnxVersalTRng),
|
|
|
|
+ VMSTATE_UINT64_ARRAY(tst_seed, XlnxVersalTRng, 2),
|
|
|
|
+ VMSTATE_UINT32_ARRAY(regs, XlnxVersalTRng, R_MAX),
|
|
|
|
+ VMSTATE_END_OF_LIST(),
|
|
|
|
+ }
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static void trng_class_init(ObjectClass *klass, void *data)
|
|
|
|
+{
|
|
|
|
+ DeviceClass *dc = DEVICE_CLASS(klass);
|
|
|
|
+ ResettableClass *rc = RESETTABLE_CLASS(klass);
|
|
|
|
+
|
|
|
|
+ dc->vmsd = &vmstate_trng;
|
|
|
|
+ dc->unrealize = trng_unrealize;
|
|
|
|
+ rc->phases.hold = trng_reset_hold;
|
|
|
|
+
|
|
|
|
+ /* Clone uint64 property with set allowed after realized */
|
|
|
|
+ trng_prop_uint64 = qdev_prop_uint64;
|
|
|
|
+ trng_prop_uint64.realized_set_allowed = true;
|
|
|
|
+ trng_props[0].info = &trng_prop_uint64;
|
|
|
|
+
|
|
|
|
+ device_class_set_props(dc, trng_props);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static const TypeInfo trng_info = {
|
|
|
|
+ .name = TYPE_XLNX_VERSAL_TRNG,
|
|
|
|
+ .parent = TYPE_SYS_BUS_DEVICE,
|
|
|
|
+ .instance_size = sizeof(XlnxVersalTRng),
|
|
|
|
+ .class_init = trng_class_init,
|
|
|
|
+ .instance_init = trng_init,
|
|
|
|
+};
|
|
|
|
+
|
|
|
|
+static void trng_register_types(void)
|
|
|
|
+{
|
|
|
|
+ type_register_static(&trng_info);
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+type_init(trng_register_types)
|