275 lines
		
	
	
		
			8.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			275 lines
		
	
	
		
			8.3 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * This library is free software; you can redistribute it and/or
							 | 
						||
| 
								 | 
							
								 * modify it under the terms of the GNU Lesser General Public
							 | 
						||
| 
								 | 
							
								 * License as published by the Free Software Foundation; either
							 | 
						||
| 
								 | 
							
								 * version 2.1 of the License, or (at your option) any later version.
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 * This library 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
							 | 
						||
| 
								 | 
							
								 * Lesser General Public License for more details.
							 | 
						||
| 
								 | 
							
								 *
							 | 
						||
| 
								 | 
							
								 * You should have received a copy of the GNU Lesser General Public
							 | 
						||
| 
								 | 
							
								 * License along with this library; if not, see <http://www.gnu.org/licenses/>.
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#include "qemu/osdep.h"
							 | 
						||
| 
								 | 
							
								#include "qapi/error.h"
							 | 
						||
| 
								 | 
							
								#include "target/ppc/cpu.h"
							 | 
						||
| 
								 | 
							
								#include "migration/vmstate.h"
							 | 
						||
| 
								 | 
							
								#include "trace.h"
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#include "hw/ppc/spapr.h"
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#define FIELD_BE(reg, field, start, len) \
							 | 
						||
| 
								 | 
							
								    FIELD(reg, field, 64 - (start + len), len)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * Bits 47: "leaveOtherWatchdogsRunningOnTimeout", specified on
							 | 
						||
| 
								 | 
							
								 * the "Start watchdog" operation,
							 | 
						||
| 
								 | 
							
								 * 0 - stop out-standing watchdogs on timeout,
							 | 
						||
| 
								 | 
							
								 * 1 - leave outstanding watchdogs running on timeout
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								FIELD_BE(PSERIES_WDTF, LEAVE_OTHER, 47, 1)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*    Bits 48-55: "operation" */
							 | 
						||
| 
								 | 
							
								FIELD_BE(PSERIES_WDTF, OP, 48, 8)
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTF_OP_START           0x1
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTF_OP_STOP            0x2
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTF_OP_QUERY           0x3
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTF_OP_QUERY_LPM       0x4
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*    Bits 56-63: "timeoutAction" */
							 | 
						||
| 
								 | 
							
								FIELD_BE(PSERIES_WDTF, ACTION, 56, 8)
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTF_ACTION_HARD_POWER_OFF  0x1
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTF_ACTION_HARD_RESTART    0x2
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTF_ACTION_DUMP_RESTART    0x3
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								FIELD_BE(PSERIES_WDTF, RESERVED, 0, 47)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/* Special watchdogNumber for the "stop all watchdogs" operation */
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDT_STOP_ALL            ((uint64_t)~0)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * For the "Query watchdog capabilities" operation, a uint64 structure
							 | 
						||
| 
								 | 
							
								 * defined as:
							 | 
						||
| 
								 | 
							
								 * Bits 0-15: The minimum supported timeout in milliseconds
							 | 
						||
| 
								 | 
							
								 * Bits 16-31: The number of watchdogs supported
							 | 
						||
| 
								 | 
							
								 * Bits 32-63: Reserved
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								FIELD_BE(PSERIES_WDTQ, MIN_TIMEOUT, 0, 16)
							 | 
						||
| 
								 | 
							
								FIELD_BE(PSERIES_WDTQ, NUM, 16, 16)
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								/*
							 | 
						||
| 
								 | 
							
								 * For the "Query watchdog LPM requirement" operation:
							 | 
						||
| 
								 | 
							
								 * 1 = The given "watchdogNumber" must be stopped prior to suspending
							 | 
						||
| 
								 | 
							
								 * 2 = The given "watchdogNumber" does not have to be stopped prior to
							 | 
						||
| 
								 | 
							
								 * suspending
							 | 
						||
| 
								 | 
							
								 */
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTQL_STOPPED               1
							 | 
						||
| 
								 | 
							
								#define PSERIES_WDTQL_QUERY_NOT_STOPPED     2
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								#define WDT_MIN_TIMEOUT 1 /* 1ms */
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static target_ulong watchdog_stop(unsigned watchdogNumber, SpaprWatchdog *w)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    target_ulong ret = H_NOOP;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if (timer_pending(&w->timer)) {
							 | 
						||
| 
								 | 
							
								        timer_del(&w->timer);
							 | 
						||
| 
								 | 
							
								        ret = H_SUCCESS;
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    trace_spapr_watchdog_stop(watchdogNumber, ret);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return ret;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static target_ulong watchdog_stop_all(SpaprMachineState *spapr)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    target_ulong ret = H_NOOP;
							 | 
						||
| 
								 | 
							
								    int i;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    for (i = 1; i <= ARRAY_SIZE(spapr->wds); ++i) {
							 | 
						||
| 
								 | 
							
								        target_ulong r = watchdog_stop(i, &spapr->wds[i - 1]);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								        if (r != H_NOOP && r != H_SUCCESS) {
							 | 
						||
| 
								 | 
							
								            ret = r;
							 | 
						||
| 
								 | 
							
								        }
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return ret;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static void watchdog_expired(void *pw)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    SpaprWatchdog *w = pw;
							 | 
						||
| 
								 | 
							
								    CPUState *cs;
							 | 
						||
| 
								 | 
							
								    SpaprMachineState *spapr = SPAPR_MACHINE(qdev_get_machine());
							 | 
						||
| 
								 | 
							
								    unsigned num = w - spapr->wds;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    g_assert(num < ARRAY_SIZE(spapr->wds));
							 | 
						||
| 
								 | 
							
								    trace_spapr_watchdog_expired(num, w->action);
							 | 
						||
| 
								 | 
							
								    switch (w->action) {
							 | 
						||
| 
								 | 
							
								    case PSERIES_WDTF_ACTION_HARD_POWER_OFF:
							 | 
						||
| 
								 | 
							
								        qemu_system_vmstop_request(RUN_STATE_SHUTDOWN);
							 | 
						||
| 
								 | 
							
								        break;
							 | 
						||
| 
								 | 
							
								    case PSERIES_WDTF_ACTION_HARD_RESTART:
							 | 
						||
| 
								 | 
							
								        qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
							 | 
						||
| 
								 | 
							
								        break;
							 | 
						||
| 
								 | 
							
								    case PSERIES_WDTF_ACTION_DUMP_RESTART:
							 | 
						||
| 
								 | 
							
								        CPU_FOREACH(cs) {
							 | 
						||
| 
								 | 
							
								            async_run_on_cpu(cs, spapr_do_system_reset_on_cpu, RUN_ON_CPU_NULL);
							 | 
						||
| 
								 | 
							
								        }
							 | 
						||
| 
								 | 
							
								        break;
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								    if (!w->leave_others) {
							 | 
						||
| 
								 | 
							
								        watchdog_stop_all(spapr);
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static target_ulong h_watchdog(PowerPCCPU *cpu,
							 | 
						||
| 
								 | 
							
								                               SpaprMachineState *spapr,
							 | 
						||
| 
								 | 
							
								                               target_ulong opcode, target_ulong *args)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    target_ulong ret = H_SUCCESS;
							 | 
						||
| 
								 | 
							
								    target_ulong flags = args[0];
							 | 
						||
| 
								 | 
							
								    target_ulong watchdogNumber = args[1]; /* 1-Based per PAPR */
							 | 
						||
| 
								 | 
							
								    target_ulong timeoutInMs = args[2];
							 | 
						||
| 
								 | 
							
								    unsigned operation = FIELD_EX64(flags, PSERIES_WDTF, OP);
							 | 
						||
| 
								 | 
							
								    unsigned timeoutAction = FIELD_EX64(flags, PSERIES_WDTF, ACTION);
							 | 
						||
| 
								 | 
							
								    SpaprWatchdog *w;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    if (FIELD_EX64(flags, PSERIES_WDTF, RESERVED)) {
							 | 
						||
| 
								 | 
							
								        return H_PARAMETER;
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    switch (operation) {
							 | 
						||
| 
								 | 
							
								    case PSERIES_WDTF_OP_START:
							 | 
						||
| 
								 | 
							
								        if (watchdogNumber > ARRAY_SIZE(spapr->wds)) {
							 | 
						||
| 
								 | 
							
								            return H_P2;
							 | 
						||
| 
								 | 
							
								        }
							 | 
						||
| 
								 | 
							
								        if (timeoutInMs <= WDT_MIN_TIMEOUT) {
							 | 
						||
| 
								 | 
							
								            return H_P3;
							 | 
						||
| 
								 | 
							
								        }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								        w = &spapr->wds[watchdogNumber - 1];
							 | 
						||
| 
								 | 
							
								        switch (timeoutAction) {
							 | 
						||
| 
								 | 
							
								        case PSERIES_WDTF_ACTION_HARD_POWER_OFF:
							 | 
						||
| 
								 | 
							
								        case PSERIES_WDTF_ACTION_HARD_RESTART:
							 | 
						||
| 
								 | 
							
								        case PSERIES_WDTF_ACTION_DUMP_RESTART:
							 | 
						||
| 
								 | 
							
								            w->action = timeoutAction;
							 | 
						||
| 
								 | 
							
								            break;
							 | 
						||
| 
								 | 
							
								        default:
							 | 
						||
| 
								 | 
							
								            return H_PARAMETER;
							 | 
						||
| 
								 | 
							
								        }
							 | 
						||
| 
								 | 
							
								        w->leave_others = FIELD_EX64(flags, PSERIES_WDTF, LEAVE_OTHER);
							 | 
						||
| 
								 | 
							
								        timer_mod(&w->timer,
							 | 
						||
| 
								 | 
							
								                  qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + timeoutInMs);
							 | 
						||
| 
								 | 
							
								        trace_spapr_watchdog_start(flags, watchdogNumber, timeoutInMs);
							 | 
						||
| 
								 | 
							
								        break;
							 | 
						||
| 
								 | 
							
								    case PSERIES_WDTF_OP_STOP:
							 | 
						||
| 
								 | 
							
								        if (watchdogNumber == PSERIES_WDT_STOP_ALL) {
							 | 
						||
| 
								 | 
							
								            ret = watchdog_stop_all(spapr);
							 | 
						||
| 
								 | 
							
								        } else if (watchdogNumber <= ARRAY_SIZE(spapr->wds)) {
							 | 
						||
| 
								 | 
							
								            ret = watchdog_stop(watchdogNumber,
							 | 
						||
| 
								 | 
							
								                                &spapr->wds[watchdogNumber - 1]);
							 | 
						||
| 
								 | 
							
								        } else {
							 | 
						||
| 
								 | 
							
								            return H_P2;
							 | 
						||
| 
								 | 
							
								        }
							 | 
						||
| 
								 | 
							
								        break;
							 | 
						||
| 
								 | 
							
								    case PSERIES_WDTF_OP_QUERY:
							 | 
						||
| 
								 | 
							
								        args[0] = FIELD_DP64(0, PSERIES_WDTQ, MIN_TIMEOUT, WDT_MIN_TIMEOUT);
							 | 
						||
| 
								 | 
							
								        args[0] = FIELD_DP64(args[0], PSERIES_WDTQ, NUM,
							 | 
						||
| 
								 | 
							
								                             ARRAY_SIZE(spapr->wds));
							 | 
						||
| 
								 | 
							
								        trace_spapr_watchdog_query(args[0]);
							 | 
						||
| 
								 | 
							
								        break;
							 | 
						||
| 
								 | 
							
								    case PSERIES_WDTF_OP_QUERY_LPM:
							 | 
						||
| 
								 | 
							
								        if (watchdogNumber > ARRAY_SIZE(spapr->wds)) {
							 | 
						||
| 
								 | 
							
								            return H_P2;
							 | 
						||
| 
								 | 
							
								        }
							 | 
						||
| 
								 | 
							
								        args[0] = PSERIES_WDTQL_QUERY_NOT_STOPPED;
							 | 
						||
| 
								 | 
							
								        trace_spapr_watchdog_query_lpm(args[0]);
							 | 
						||
| 
								 | 
							
								        break;
							 | 
						||
| 
								 | 
							
								    default:
							 | 
						||
| 
								 | 
							
								        return H_PARAMETER;
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return ret;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								void spapr_watchdog_init(SpaprMachineState *spapr)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    int i;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    for (i = 0; i < ARRAY_SIZE(spapr->wds); ++i) {
							 | 
						||
| 
								 | 
							
								        char name[16];
							 | 
						||
| 
								 | 
							
								        SpaprWatchdog *w = &spapr->wds[i];
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								        snprintf(name, sizeof(name) - 1, "wdt%d", i + 1);
							 | 
						||
| 
								 | 
							
								        object_initialize_child_with_props(OBJECT(spapr), name, w,
							 | 
						||
| 
								 | 
							
								                                           sizeof(SpaprWatchdog),
							 | 
						||
| 
								 | 
							
								                                           TYPE_SPAPR_WDT,
							 | 
						||
| 
								 | 
							
								                                           &error_fatal, NULL);
							 | 
						||
| 
								 | 
							
								        qdev_realize(DEVICE(w), NULL, &error_fatal);
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static bool watchdog_needed(void *opaque)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    SpaprWatchdog *w = opaque;
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    return timer_pending(&w->timer);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static const VMStateDescription vmstate_wdt = {
							 | 
						||
| 
								 | 
							
								    .name = "spapr_watchdog",
							 | 
						||
| 
								 | 
							
								    .version_id = 1,
							 | 
						||
| 
								 | 
							
								    .minimum_version_id = 1,
							 | 
						||
| 
								 | 
							
								    .needed = watchdog_needed,
							 | 
						||
| 
								 | 
							
								    .fields = (VMStateField[]) {
							 | 
						||
| 
								 | 
							
								        VMSTATE_TIMER(timer, SpaprWatchdog),
							 | 
						||
| 
								 | 
							
								        VMSTATE_UINT8(action, SpaprWatchdog),
							 | 
						||
| 
								 | 
							
								        VMSTATE_UINT8(leave_others, SpaprWatchdog),
							 | 
						||
| 
								 | 
							
								        VMSTATE_END_OF_LIST()
							 | 
						||
| 
								 | 
							
								    }
							 | 
						||
| 
								 | 
							
								};
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static void spapr_wdt_realize(DeviceState *dev, Error **errp)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    SpaprWatchdog *w = SPAPR_WDT(dev);
							 | 
						||
| 
								 | 
							
								    Object *o = OBJECT(dev);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    timer_init_ms(&w->timer, QEMU_CLOCK_VIRTUAL, watchdog_expired, w);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    object_property_add_uint64_ptr(o, "expire",
							 | 
						||
| 
								 | 
							
								                                   (uint64_t *)&w->timer.expire_time,
							 | 
						||
| 
								 | 
							
								                                   OBJ_PROP_FLAG_READ);
							 | 
						||
| 
								 | 
							
								    object_property_add_uint8_ptr(o, "action", &w->action, OBJ_PROP_FLAG_READ);
							 | 
						||
| 
								 | 
							
								    object_property_add_uint8_ptr(o, "leaveOtherWatchdogsRunningOnTimeout",
							 | 
						||
| 
								 | 
							
								                                  &w->leave_others, OBJ_PROP_FLAG_READ);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static void spapr_wdt_class_init(ObjectClass *oc, void *data)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    DeviceClass *dc = DEVICE_CLASS(oc);
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								    dc->realize = spapr_wdt_realize;
							 | 
						||
| 
								 | 
							
								    dc->vmsd = &vmstate_wdt;
							 | 
						||
| 
								 | 
							
								    dc->user_creatable = false;
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static const TypeInfo spapr_wdt_info = {
							 | 
						||
| 
								 | 
							
								    .name          = TYPE_SPAPR_WDT,
							 | 
						||
| 
								 | 
							
								    .parent        = TYPE_DEVICE,
							 | 
						||
| 
								 | 
							
								    .instance_size = sizeof(SpaprWatchdog),
							 | 
						||
| 
								 | 
							
								    .class_init    = spapr_wdt_class_init,
							 | 
						||
| 
								 | 
							
								};
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								static void spapr_watchdog_register_types(void)
							 | 
						||
| 
								 | 
							
								{
							 | 
						||
| 
								 | 
							
								    spapr_register_hypercall(H_WATCHDOG, h_watchdog);
							 | 
						||
| 
								 | 
							
								    type_register_static(&spapr_wdt_info);
							 | 
						||
| 
								 | 
							
								}
							 | 
						||
| 
								 | 
							
								
							 | 
						||
| 
								 | 
							
								type_init(spapr_watchdog_register_types)
							 |