These changes are the raw update to linux-4.4.6-rt14. Kernel sources
[kvmfornfv.git] / kernel / arch / s390 / kernel / nmi.c
index 56b5508..07302ce 100644 (file)
 #include <asm/ctl_reg.h>
 
 struct mcck_struct {
-       int kill_task;
-       int channel_report;
-       int warning;
-       unsigned long long mcck_code;
+       unsigned int kill_task : 1;
+       unsigned int channel_report : 1;
+       unsigned int warning : 1;
+       unsigned int etr_queue : 1;
+       unsigned int stp_queue : 1;
+       unsigned long mcck_code;
 };
 
 static DEFINE_PER_CPU(struct mcck_struct, cpu_mcck);
 
-static void s390_handle_damage(char *msg)
+static void s390_handle_damage(void)
 {
        smp_send_stop();
        disabled_wait((unsigned long) __builtin_return_address(0));
@@ -80,10 +82,14 @@ void s390_handle_mcck(void)
                if (xchg(&mchchk_wng_posted, 1) == 0)
                        kill_cad_pid(SIGPWR, 1);
        }
+       if (mcck.etr_queue)
+               etr_queue_work();
+       if (mcck.stp_queue)
+               stp_queue_work();
        if (mcck.kill_task) {
                local_irq_enable();
                printk(KERN_EMERG "mcck: Terminating task because of machine "
-                      "malfunction (code 0x%016llx).\n", mcck.mcck_code);
+                      "malfunction (code 0x%016lx).\n", mcck.mcck_code);
                printk(KERN_EMERG "mcck: task: %s, pid: %d.\n",
                       current->comm, current->pid);
                do_exit(SIGSEGV);
@@ -95,7 +101,7 @@ EXPORT_SYMBOL_GPL(s390_handle_mcck);
  * returns 0 if all registers could be validated
  * returns 1 otherwise
  */
-static int notrace s390_revalidate_registers(struct mci *mci)
+static int notrace s390_validate_registers(union mci mci)
 {
        int kill_task;
        u64 zero;
@@ -104,14 +110,14 @@ static int notrace s390_revalidate_registers(struct mci *mci)
        kill_task = 0;
        zero = 0;
 
-       if (!mci->gr) {
+       if (!mci.gr) {
                /*
                 * General purpose registers couldn't be restored and have
                 * unknown contents. Process needs to be terminated.
                 */
                kill_task = 1;
        }
-       if (!mci->fp) {
+       if (!mci.fp) {
                /*
                 * Floating point registers can't be restored and
                 * therefore the process needs to be terminated.
@@ -120,7 +126,7 @@ static int notrace s390_revalidate_registers(struct mci *mci)
        }
        fpt_save_area = &S390_lowcore.floating_pt_save_area;
        fpt_creg_save_area = &S390_lowcore.fpt_creg_save_area;
-       if (!mci->fc) {
+       if (!mci.fc) {
                /*
                 * Floating point control register can't be restored.
                 * Task will be terminated.
@@ -131,7 +137,7 @@ static int notrace s390_revalidate_registers(struct mci *mci)
                asm volatile("lfpc 0(%0)" : : "a" (fpt_creg_save_area));
 
        if (!MACHINE_HAS_VX) {
-               /* Revalidate floating point registers */
+               /* Validate floating point registers */
                asm volatile(
                        "       ld      0,0(%0)\n"
                        "       ld      1,8(%0)\n"
@@ -151,10 +157,10 @@ static int notrace s390_revalidate_registers(struct mci *mci)
                        "       ld      15,120(%0)\n"
                        : : "a" (fpt_save_area));
        } else {
-               /* Revalidate vector registers */
+               /* Validate vector registers */
                union ctlreg0 cr0;
 
-               if (!mci->vr) {
+               if (!mci.vr) {
                        /*
                         * Vector registers can't be restored and therefore
                         * the process needs to be terminated.
@@ -164,42 +170,46 @@ static int notrace s390_revalidate_registers(struct mci *mci)
                cr0.val = S390_lowcore.cregs_save_area[0];
                cr0.afp = cr0.vx = 1;
                __ctl_load(cr0.val, 0, 0);
-               restore_vx_regs((__vector128 *)
-                               &S390_lowcore.vector_save_area);
+               asm volatile(
+                       "       la      1,%0\n"
+                       "       .word   0xe70f,0x1000,0x0036\n" /* vlm 0,15,0(1) */
+                       "       .word   0xe70f,0x1100,0x0c36\n" /* vlm 16,31,256(1) */
+                       : : "Q" (*(struct vx_array *)
+                                &S390_lowcore.vector_save_area) : "1");
                __ctl_load(S390_lowcore.cregs_save_area[0], 0, 0);
        }
-       /* Revalidate access registers */
+       /* Validate access registers */
        asm volatile(
                "       lam     0,15,0(%0)"
                : : "a" (&S390_lowcore.access_regs_save_area));
-       if (!mci->ar) {
+       if (!mci.ar) {
                /*
                 * Access registers have unknown contents.
                 * Terminating task.
                 */
                kill_task = 1;
        }
-       /* Revalidate control registers */
-       if (!mci->cr) {
+       /* Validate control registers */
+       if (!mci.cr) {
                /*
                 * Control registers have unknown contents.
                 * Can't recover and therefore stopping machine.
                 */
-               s390_handle_damage("invalid control registers.");
+               s390_handle_damage();
        } else {
                asm volatile(
                        "       lctlg   0,15,0(%0)"
                        : : "a" (&S390_lowcore.cregs_save_area));
        }
        /*
-        * We don't even try to revalidate the TOD register, since we simply
+        * We don't even try to validate the TOD register, since we simply
         * can't write something sensible into that register.
         */
        /*
-        * See if we can revalidate the TOD programmable register with its
+        * See if we can validate the TOD programmable register with its
         * old contents (should be zero) otherwise set it to zero.
         */
-       if (!mci->pr)
+       if (!mci.pr)
                asm volatile(
                        "       sr      0,0\n"
                        "       sckpf"
@@ -210,17 +220,17 @@ static int notrace s390_revalidate_registers(struct mci *mci)
                        "       sckpf"
                        : : "a" (&S390_lowcore.tod_progreg_save_area)
                        : "0", "cc");
-       /* Revalidate clock comparator register */
+       /* Validate clock comparator register */
        set_clock_comparator(S390_lowcore.clock_comparator);
        /* Check if old PSW is valid */
-       if (!mci->wp)
+       if (!mci.wp)
                /*
                 * Can't tell if we come from user or kernel mode
                 * -> stopping machine.
                 */
-               s390_handle_damage("old psw invalid.");
+               s390_handle_damage();
 
-       if (!mci->ms || !mci->pm || !mci->ia)
+       if (!mci.ms || !mci.pm || !mci.ia)
                kill_task = 1;
 
        return kill_task;
@@ -244,21 +254,21 @@ void notrace s390_do_machine_check(struct pt_regs *regs)
        static unsigned long long last_ipd;
        struct mcck_struct *mcck;
        unsigned long long tmp;
-       struct mci *mci;
+       union mci mci;
        int umode;
 
        nmi_enter();
        inc_irq_stat(NMI_NMI);
-       mci = (struct mci *) &S390_lowcore.mcck_interruption_code;
+       mci.val = S390_lowcore.mcck_interruption_code;
        mcck = this_cpu_ptr(&cpu_mcck);
        umode = user_mode(regs);
 
-       if (mci->sd) {
+       if (mci.sd) {
                /* System damage -> stopping machine */
-               s390_handle_damage("received system damage machine check.");
+               s390_handle_damage();
        }
-       if (mci->pd) {
-               if (mci->b) {
+       if (mci.pd) {
+               if (mci.b) {
                        /* Processing backup -> verify if we can survive this */
                        u64 z_mcic, o_mcic, t_mcic;
                        z_mcic = (1ULL<<63 | 1ULL<<59 | 1ULL<<29);
@@ -266,12 +276,11 @@ void notrace s390_do_machine_check(struct pt_regs *regs)
                                  1ULL<<36 | 1ULL<<35 | 1ULL<<34 | 1ULL<<32 |
                                  1ULL<<30 | 1ULL<<21 | 1ULL<<20 | 1ULL<<17 |
                                  1ULL<<16);
-                       t_mcic = *(u64 *)mci;
+                       t_mcic = mci.val;
 
                        if (((t_mcic & z_mcic) != 0) ||
                            ((t_mcic & o_mcic) != o_mcic)) {
-                               s390_handle_damage("processing backup machine "
-                                                  "check with damage.");
+                               s390_handle_damage();
                        }
 
                        /*
@@ -286,64 +295,62 @@ void notrace s390_do_machine_check(struct pt_regs *regs)
                                ipd_count = 1;
                        last_ipd = tmp;
                        if (ipd_count == MAX_IPD_COUNT)
-                               s390_handle_damage("too many ipd retries.");
+                               s390_handle_damage();
                        spin_unlock(&ipd_lock);
                } else {
                        /* Processing damage -> stopping machine */
-                       s390_handle_damage("received instruction processing "
-                                          "damage machine check.");
+                       s390_handle_damage();
                }
        }
-       if (s390_revalidate_registers(mci)) {
+       if (s390_validate_registers(mci)) {
                if (umode) {
                        /*
                         * Couldn't restore all register contents while in
                         * user mode -> mark task for termination.
                         */
                        mcck->kill_task = 1;
-                       mcck->mcck_code = *(unsigned long long *) mci;
+                       mcck->mcck_code = mci.val;
                        set_cpu_flag(CIF_MCCK_PENDING);
                } else {
                        /*
                         * Couldn't restore all register contents while in
                         * kernel mode -> stopping machine.
                         */
-                       s390_handle_damage("unable to revalidate registers.");
+                       s390_handle_damage();
                }
        }
-       if (mci->cd) {
+       if (mci.cd) {
                /* Timing facility damage */
-               s390_handle_damage("TOD clock damaged");
+               s390_handle_damage();
        }
-       if (mci->ed && mci->ec) {
+       if (mci.ed && mci.ec) {
                /* External damage */
                if (S390_lowcore.external_damage_code & (1U << ED_ETR_SYNC))
-                       etr_sync_check();
+                       mcck->etr_queue |= etr_sync_check();
                if (S390_lowcore.external_damage_code & (1U << ED_ETR_SWITCH))
-                       etr_switch_to_local();
+                       mcck->etr_queue |= etr_switch_to_local();
                if (S390_lowcore.external_damage_code & (1U << ED_STP_SYNC))
-                       stp_sync_check();
+                       mcck->stp_queue |= stp_sync_check();
                if (S390_lowcore.external_damage_code & (1U << ED_STP_ISLAND))
-                       stp_island_check();
+                       mcck->stp_queue |= stp_island_check();
+               if (mcck->etr_queue || mcck->stp_queue)
+                       set_cpu_flag(CIF_MCCK_PENDING);
        }
-       if (mci->se)
+       if (mci.se)
                /* Storage error uncorrected */
-               s390_handle_damage("received storage error uncorrected "
-                                  "machine check.");
-       if (mci->ke)
+               s390_handle_damage();
+       if (mci.ke)
                /* Storage key-error uncorrected */
-               s390_handle_damage("received storage key-error uncorrected "
-                                  "machine check.");
-       if (mci->ds && mci->fa)
+               s390_handle_damage();
+       if (mci.ds && mci.fa)
                /* Storage degradation */
-               s390_handle_damage("received storage degradation machine "
-                                  "check.");
-       if (mci->cp) {
+               s390_handle_damage();
+       if (mci.cp) {
                /* Channel report word pending */
                mcck->channel_report = 1;
                set_cpu_flag(CIF_MCCK_PENDING);
        }
-       if (mci->w) {
+       if (mci.w) {
                /* Warning pending */
                mcck->warning = 1;
                set_cpu_flag(CIF_MCCK_PENDING);
@@ -358,4 +365,4 @@ static int __init machine_check_init(void)
        ctl_set_bit(14, 24);    /* enable warning MCH */
        return 0;
 }
-arch_initcall(machine_check_init);
+early_initcall(machine_check_init);