// SPDX-License-Identifier: GPL-2.0

#define pr_fmt(fmt) "x86/split lock detection: " fmt

#include <linux/semaphore.h>
#include <linux/workqueue.h>
#include <linux/delay.h>
#include <linux/cpuhotplug.h>
#include <linux/kvm_types.h>
#include <asm/cpu_device_id.h>
#include <asm/cmdline.h>
#include <asm/traps.h>
#include <asm/cpu.h>
#include <asm/msr.h>

enum split_lock_detect_state {
        sld_off = 0,
        sld_warn,
        sld_fatal,
        sld_ratelimit,
};

/*
 * Default to sld_off because most systems do not support split lock detection.
 * sld_state_setup() will switch this to sld_warn on systems that support
 * split lock/bus lock detect, unless there is a command line override.
 */
static enum split_lock_detect_state sld_state __ro_after_init = sld_off;
static u64 msr_test_ctrl_cache __ro_after_init;

/*
 * With a name like MSR_TEST_CTL it should go without saying, but don't touch
 * MSR_TEST_CTL unless the CPU is one of the whitelisted models.  Writing it
 * on CPUs that do not support SLD can cause fireworks, even when writing '0'.
 */
static bool cpu_model_supports_sld __ro_after_init;

static const struct {
        const char                      *option;
        enum split_lock_detect_state    state;
} sld_options[] __initconst = {
        { "off",        sld_off   },
        { "warn",       sld_warn  },
        { "fatal",      sld_fatal },
        { "ratelimit:", sld_ratelimit },
};

static struct ratelimit_state bld_ratelimit;

static unsigned int sysctl_sld_mitigate = 1;
static DEFINE_SEMAPHORE(buslock_sem, 1);

#ifdef CONFIG_PROC_SYSCTL
static const struct ctl_table sld_sysctls[] = {
        {
                .procname       = "split_lock_mitigate",
                .data           = &sysctl_sld_mitigate,
                .maxlen         = sizeof(unsigned int),
                .mode           = 0644,
                .proc_handler   = proc_douintvec_minmax,
                .extra1         = SYSCTL_ZERO,
                .extra2         = SYSCTL_ONE,
        },
};

static int __init sld_mitigate_sysctl_init(void)
{
        register_sysctl_init("kernel", sld_sysctls);
        return 0;
}

late_initcall(sld_mitigate_sysctl_init);
#endif

static inline bool match_option(const char *arg, int arglen, const char *opt)
{
        int len = strlen(opt), ratelimit;

        if (strncmp(arg, opt, len))
                return false;

        /*
         * Min ratelimit is 1 bus lock/sec.
         * Max ratelimit is 1000 bus locks/sec.
         */
        if (sscanf(arg, "ratelimit:%d", &ratelimit) == 1 &&
            ratelimit > 0 && ratelimit <= 1000) {
                ratelimit_state_init(&bld_ratelimit, HZ, ratelimit);
                ratelimit_set_flags(&bld_ratelimit, RATELIMIT_MSG_ON_RELEASE);
                return true;
        }

        return len == arglen;
}

static bool split_lock_verify_msr(bool on)
{
        u64 ctrl, tmp;

        if (rdmsrq_safe(MSR_TEST_CTRL, &ctrl))
                return false;
        if (on)
                ctrl |= MSR_TEST_CTRL_SPLIT_LOCK_DETECT;
        else
                ctrl &= ~MSR_TEST_CTRL_SPLIT_LOCK_DETECT;
        if (wrmsrq_safe(MSR_TEST_CTRL, ctrl))
                return false;
        rdmsrq(MSR_TEST_CTRL, tmp);
        return ctrl == tmp;
}

static void __init sld_state_setup(void)
{
        enum split_lock_detect_state state = sld_warn;
        char arg[20];
        int i, ret;

        if (!boot_cpu_has(X86_FEATURE_SPLIT_LOCK_DETECT) &&
            !boot_cpu_has(X86_FEATURE_BUS_LOCK_DETECT))
                return;

        ret = cmdline_find_option(boot_command_line, "split_lock_detect",
                                  arg, sizeof(arg));
        if (ret >= 0) {
                for (i = 0; i < ARRAY_SIZE(sld_options); i++) {
                        if (match_option(arg, ret, sld_options[i].option)) {
                                state = sld_options[i].state;
                                break;
                        }
                }
        }
        sld_state = state;
}

static void __init __split_lock_setup(void)
{
        if (!split_lock_verify_msr(false)) {
                pr_info("MSR access failed: Disabled\n");
                return;
        }

        rdmsrq(MSR_TEST_CTRL, msr_test_ctrl_cache);

        if (!split_lock_verify_msr(true)) {
                pr_info("MSR access failed: Disabled\n");
                return;
        }

        /* Restore the MSR to its cached value. */
        wrmsrq(MSR_TEST_CTRL, msr_test_ctrl_cache);

        setup_force_cpu_cap(X86_FEATURE_SPLIT_LOCK_DETECT);
}

/*
 * MSR_TEST_CTRL is per core, but we treat it like a per CPU MSR. Locking
 * is not implemented as one thread could undo the setting of the other
 * thread immediately after dropping the lock anyway.
 */
static void sld_update_msr(bool on)
{
        u64 test_ctrl_val = msr_test_ctrl_cache;

        if (on)
                test_ctrl_val |= MSR_TEST_CTRL_SPLIT_LOCK_DETECT;

        wrmsrq(MSR_TEST_CTRL, test_ctrl_val);
}

void split_lock_init(void)
{
        /*
         * #DB for bus lock handles ratelimit and #AC for split lock is
         * disabled.
         */
        if (sld_state == sld_ratelimit) {
                split_lock_verify_msr(false);
                return;
        }

        if (cpu_model_supports_sld)
                split_lock_verify_msr(sld_state != sld_off);
}

static void __split_lock_reenable_unlock(struct work_struct *work)
{
        sld_update_msr(true);
        up(&buslock_sem);
}

static DECLARE_DELAYED_WORK(sl_reenable_unlock, __split_lock_reenable_unlock);

static void __split_lock_reenable(struct work_struct *work)
{
        sld_update_msr(true);
}
/*
 * In order for each CPU to schedule its delayed work independently of the
 * others, delayed work struct must be per-CPU. This is not required when
 * sysctl_sld_mitigate is enabled because of the semaphore that limits
 * the number of simultaneously scheduled delayed works to 1.
 */
static DEFINE_PER_CPU(struct delayed_work, sl_reenable);

/*
 * Per-CPU delayed_work can't be statically initialized properly because
 * the struct address is unknown. Thus per-CPU delayed_work structures
 * have to be initialized during kernel initialization and after calling
 * setup_per_cpu_areas().
 */
static int __init setup_split_lock_delayed_work(void)
{
        unsigned int cpu;

        for_each_possible_cpu(cpu) {
                struct delayed_work *work = per_cpu_ptr(&sl_reenable, cpu);

                INIT_DELAYED_WORK(work, __split_lock_reenable);
        }

        return 0;
}
pure_initcall(setup_split_lock_delayed_work);

/*
 * If a CPU goes offline with pending delayed work to re-enable split lock
 * detection then the delayed work will be executed on some other CPU. That
 * handles releasing the buslock_sem, but because it executes on a
 * different CPU probably won't re-enable split lock detection. This is a
 * problem on HT systems since the sibling CPU on the same core may then be
 * left running with split lock detection disabled.
 *
 * Unconditionally re-enable detection here.
 */
static int splitlock_cpu_offline(unsigned int cpu)
{
        sld_update_msr(true);

        return 0;
}

static void split_lock_warn(unsigned long ip)
{
        struct delayed_work *work;
        int cpu;
        unsigned int saved_sld_mitigate = READ_ONCE(sysctl_sld_mitigate);

        if (!current->reported_split_lock)
                pr_warn_ratelimited("#AC: %s/%d took a split_lock trap at address: 0x%lx\n",
                                    current->comm, current->pid, ip);
        current->reported_split_lock = 1;

        if (saved_sld_mitigate) {
                /*
                 * misery factor #1:
                 * sleep 10ms before trying to execute split lock.
                 */
                if (msleep_interruptible(10) > 0)
                        return;
                /*
                 * Misery factor #2:
                 * only allow one buslocked disabled core at a time.
                 */
                if (down_interruptible(&buslock_sem) == -EINTR)
                        return;
        }

        cpu = get_cpu();
        work = saved_sld_mitigate ? &sl_reenable_unlock : per_cpu_ptr(&sl_reenable, cpu);
        schedule_delayed_work_on(cpu, work, 2);

        /* Disable split lock detection on this CPU to make progress */
        sld_update_msr(false);
        put_cpu();
}

bool handle_guest_split_lock(unsigned long ip)
{
        if (sld_state == sld_warn) {
                split_lock_warn(ip);
                return true;
        }

        pr_warn_once("#AC: %s/%d %s split_lock trap at address: 0x%lx\n",
                     current->comm, current->pid,
                     sld_state == sld_fatal ? "fatal" : "bogus", ip);

        current->thread.error_code = 0;
        current->thread.trap_nr = X86_TRAP_AC;
        force_sig_fault(SIGBUS, BUS_ADRALN, NULL);
        return false;
}
EXPORT_SYMBOL_FOR_KVM(handle_guest_split_lock);

void bus_lock_init(void)
{
        u64 val;

        if (!boot_cpu_has(X86_FEATURE_BUS_LOCK_DETECT))
                return;

        rdmsrq(MSR_IA32_DEBUGCTLMSR, val);

        if ((boot_cpu_has(X86_FEATURE_SPLIT_LOCK_DETECT) &&
            (sld_state == sld_warn || sld_state == sld_fatal)) ||
            sld_state == sld_off) {
                /*
                 * Warn and fatal are handled by #AC for split lock if #AC for
                 * split lock is supported.
                 */
                val &= ~DEBUGCTLMSR_BUS_LOCK_DETECT;
        } else {
                val |= DEBUGCTLMSR_BUS_LOCK_DETECT;
        }

        wrmsrq(MSR_IA32_DEBUGCTLMSR, val);
}

bool handle_user_split_lock(struct pt_regs *regs, long error_code)
{
        if ((regs->flags & X86_EFLAGS_AC) || sld_state == sld_fatal)
                return false;
        split_lock_warn(regs->ip);
        return true;
}

void handle_bus_lock(struct pt_regs *regs)
{
        switch (sld_state) {
        case sld_off:
                break;
        case sld_ratelimit:
                /* Enforce no more than bld_ratelimit bus locks/sec. */
                while (!__ratelimit(&bld_ratelimit))
                        msleep(20);
                /* Warn on the bus lock. */
                fallthrough;
        case sld_warn:
                pr_warn_ratelimited("#DB: %s/%d took a bus_lock trap at address: 0x%lx\n",
                                    current->comm, current->pid, regs->ip);
                break;
        case sld_fatal:
                force_sig_fault(SIGBUS, BUS_ADRALN, NULL);
                break;
        }
}

/*
 * CPU models that are known to have the per-core split-lock detection
 * feature even though they do not enumerate IA32_CORE_CAPABILITIES.
 */
static const struct x86_cpu_id split_lock_cpu_ids[] __initconst = {
        X86_MATCH_VFM(INTEL_ICELAKE_X,  0),
        X86_MATCH_VFM(INTEL_ICELAKE_L,  0),
        X86_MATCH_VFM(INTEL_ICELAKE_D,  0),
        {}
};

static void __init split_lock_setup(struct cpuinfo_x86 *c)
{
        const struct x86_cpu_id *m;
        u64 ia32_core_caps;

        if (boot_cpu_has(X86_FEATURE_HYPERVISOR))
                return;

        /* Check for CPUs that have support but do not enumerate it: */
        m = x86_match_cpu(split_lock_cpu_ids);
        if (m)
                goto supported;

        if (!cpu_has(c, X86_FEATURE_CORE_CAPABILITIES))
                return;

        /*
         * Not all bits in MSR_IA32_CORE_CAPS are architectural, but
         * MSR_IA32_CORE_CAPS_SPLIT_LOCK_DETECT is.  All CPUs that set
         * it have split lock detection.
         */
        rdmsrq(MSR_IA32_CORE_CAPS, ia32_core_caps);
        if (ia32_core_caps & MSR_IA32_CORE_CAPS_SPLIT_LOCK_DETECT)
                goto supported;

        /* CPU is not in the model list and does not have the MSR bit: */
        return;

supported:
        cpu_model_supports_sld = true;
        __split_lock_setup();
}

static void sld_state_show(void)
{
        if (!boot_cpu_has(X86_FEATURE_BUS_LOCK_DETECT) &&
            !boot_cpu_has(X86_FEATURE_SPLIT_LOCK_DETECT))
                return;

        switch (sld_state) {
        case sld_off:
                pr_info("disabled\n");
                break;
        case sld_warn:
                if (boot_cpu_has(X86_FEATURE_SPLIT_LOCK_DETECT)) {
                        pr_info("#AC: crashing the kernel on kernel split_locks and warning on user-space split_locks\n");
                        if (cpuhp_setup_state(CPUHP_AP_ONLINE_DYN,
                                              "x86/splitlock", NULL, splitlock_cpu_offline) < 0)
                                pr_warn("No splitlock CPU offline handler\n");
                } else if (boot_cpu_has(X86_FEATURE_BUS_LOCK_DETECT)) {
                        pr_info("#DB: warning on user-space bus_locks\n");
                }
                break;
        case sld_fatal:
                if (boot_cpu_has(X86_FEATURE_SPLIT_LOCK_DETECT))
                        pr_info("#AC: crashing the kernel on kernel split_locks and sending SIGBUS on user-space split_locks\n");
                else if (boot_cpu_has(X86_FEATURE_BUS_LOCK_DETECT))
                        pr_info("#DB: sending SIGBUS on user-space bus_locks\n");
                break;
        case sld_ratelimit:
                if (boot_cpu_has(X86_FEATURE_BUS_LOCK_DETECT))
                        pr_info("#DB: setting system wide bus lock rate limit to %u/sec\n", bld_ratelimit.burst);
                break;
        }
}

void __init sld_setup(struct cpuinfo_x86 *c)
{
        split_lock_setup(c);
        sld_state_setup();
        sld_state_show();
}