![Pratyush Anand](/assets/img/avatar_default.png)
/sys/class/watchdog/watchdogn/device/modalias can help to identify the driver/module for a given watchdog node. However, many wdt devices do not set their parent and so, we do not see an entry for device in sysfs for such devices. This patch fixes parent of watchdog_device so that /sys/class/watchdog/watchdogn/device is populated. Exceptions: booke, diag288, octeon, softdog and w83627hf -- They do not have any parent. Not sure, how we can identify driver for these devices. Signed-off-by: Pratyush Anand <panand@redhat.com> Reviewed-by: Johannes Thumshirn <jthumshirn@suse.de> Acked-by: Guenter Roeck <linux@roeck-us.net> Acked-by: H Hartley Sweeten <hsweeten@visionengravers.com> Acked-by: Lee Jones <lee.jones@linaro.org> Acked-by: Lubomir Rintel <lkundrak@v3.sk> Acked-by: Maxime Coquelin <maxime.coquelin@st.com> Acked-by: Thierry Reding <treding@nvidia.com> Acked-by: Viresh Kumar <viresh.kumar@linaro.org> Acked-by: Linus Walleij <linus.walleij@linaro.org> Signed-off-by: Wim Van Sebroeck <wim@iguana.be>
392 lines
8.5 KiB
C
392 lines
8.5 KiB
C
/*
|
|
*
|
|
* Intel Management Engine Interface (Intel MEI) Linux driver
|
|
* Copyright (c) 2003-2012, Intel Corporation.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope 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.
|
|
*
|
|
*/
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/moduleparam.h>
|
|
#include <linux/device.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/watchdog.h>
|
|
|
|
#include <linux/mei.h>
|
|
|
|
#include "mei_dev.h"
|
|
#include "hbm.h"
|
|
#include "client.h"
|
|
|
|
static const u8 mei_start_wd_params[] = { 0x02, 0x12, 0x13, 0x10 };
|
|
static const u8 mei_stop_wd_params[] = { 0x02, 0x02, 0x14, 0x10 };
|
|
|
|
/*
|
|
* AMT Watchdog Device
|
|
*/
|
|
#define INTEL_AMT_WATCHDOG_ID "INTCAMT"
|
|
|
|
/* UUIDs for AMT F/W clients */
|
|
const uuid_le mei_wd_guid = UUID_LE(0x05B79A6F, 0x4628, 0x4D7F, 0x89,
|
|
0x9D, 0xA9, 0x15, 0x14, 0xCB,
|
|
0x32, 0xAB);
|
|
|
|
static void mei_wd_set_start_timeout(struct mei_device *dev, u16 timeout)
|
|
{
|
|
dev_dbg(dev->dev, "wd: set timeout=%d.\n", timeout);
|
|
memcpy(dev->wd_data, mei_start_wd_params, MEI_WD_HDR_SIZE);
|
|
memcpy(dev->wd_data + MEI_WD_HDR_SIZE, &timeout, sizeof(u16));
|
|
}
|
|
|
|
/**
|
|
* mei_wd_host_init - connect to the watchdog client
|
|
*
|
|
* @dev: the device structure
|
|
* @me_cl: me client
|
|
*
|
|
* Return: -ENOTTY if wd client cannot be found
|
|
* -EIO if write has failed
|
|
* 0 on success
|
|
*/
|
|
int mei_wd_host_init(struct mei_device *dev, struct mei_me_client *me_cl)
|
|
{
|
|
struct mei_cl *cl = &dev->wd_cl;
|
|
int ret;
|
|
|
|
mei_cl_init(cl, dev);
|
|
|
|
dev->wd_timeout = MEI_WD_DEFAULT_TIMEOUT;
|
|
dev->wd_state = MEI_WD_IDLE;
|
|
|
|
ret = mei_cl_link(cl, MEI_WD_HOST_CLIENT_ID);
|
|
if (ret < 0) {
|
|
dev_info(dev->dev, "wd: failed link client\n");
|
|
return ret;
|
|
}
|
|
|
|
ret = mei_cl_connect(cl, me_cl, NULL);
|
|
if (ret) {
|
|
dev_err(dev->dev, "wd: failed to connect = %d\n", ret);
|
|
mei_cl_unlink(cl);
|
|
return ret;
|
|
}
|
|
|
|
ret = mei_watchdog_register(dev);
|
|
if (ret) {
|
|
mei_cl_disconnect(cl);
|
|
mei_cl_unlink(cl);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* mei_wd_send - sends watch dog message to fw.
|
|
*
|
|
* @dev: the device structure
|
|
*
|
|
* Return: 0 if success,
|
|
* -EIO when message send fails
|
|
* -EINVAL when invalid message is to be sent
|
|
* -ENODEV on flow control failure
|
|
*/
|
|
int mei_wd_send(struct mei_device *dev)
|
|
{
|
|
struct mei_cl *cl = &dev->wd_cl;
|
|
struct mei_msg_hdr hdr;
|
|
int ret;
|
|
|
|
hdr.host_addr = cl->host_client_id;
|
|
hdr.me_addr = mei_cl_me_id(cl);
|
|
hdr.msg_complete = 1;
|
|
hdr.reserved = 0;
|
|
hdr.internal = 0;
|
|
|
|
if (!memcmp(dev->wd_data, mei_start_wd_params, MEI_WD_HDR_SIZE))
|
|
hdr.length = MEI_WD_START_MSG_SIZE;
|
|
else if (!memcmp(dev->wd_data, mei_stop_wd_params, MEI_WD_HDR_SIZE))
|
|
hdr.length = MEI_WD_STOP_MSG_SIZE;
|
|
else {
|
|
dev_err(dev->dev, "wd: invalid message is to be sent, aborting\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = mei_write_message(dev, &hdr, dev->wd_data);
|
|
if (ret) {
|
|
dev_err(dev->dev, "wd: write message failed\n");
|
|
return ret;
|
|
}
|
|
|
|
ret = mei_cl_flow_ctrl_reduce(cl);
|
|
if (ret) {
|
|
dev_err(dev->dev, "wd: flow_ctrl_reduce failed.\n");
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* mei_wd_stop - sends watchdog stop message to fw.
|
|
*
|
|
* @dev: the device structure
|
|
*
|
|
* Return: 0 if success
|
|
* on error:
|
|
* -EIO when message send fails
|
|
* -EINVAL when invalid message is to be sent
|
|
* -ETIME on message timeout
|
|
*/
|
|
int mei_wd_stop(struct mei_device *dev)
|
|
{
|
|
struct mei_cl *cl = &dev->wd_cl;
|
|
int ret;
|
|
|
|
if (!mei_cl_is_connected(cl) ||
|
|
dev->wd_state != MEI_WD_RUNNING)
|
|
return 0;
|
|
|
|
memcpy(dev->wd_data, mei_stop_wd_params, MEI_WD_STOP_MSG_SIZE);
|
|
|
|
dev->wd_state = MEI_WD_STOPPING;
|
|
|
|
ret = mei_cl_flow_ctrl_creds(cl);
|
|
if (ret < 0)
|
|
goto err;
|
|
|
|
if (ret && mei_hbuf_acquire(dev)) {
|
|
ret = mei_wd_send(dev);
|
|
if (ret)
|
|
goto err;
|
|
dev->wd_pending = false;
|
|
} else {
|
|
dev->wd_pending = true;
|
|
}
|
|
|
|
mutex_unlock(&dev->device_lock);
|
|
|
|
ret = wait_event_timeout(dev->wait_stop_wd,
|
|
dev->wd_state == MEI_WD_IDLE,
|
|
msecs_to_jiffies(MEI_WD_STOP_TIMEOUT));
|
|
mutex_lock(&dev->device_lock);
|
|
if (dev->wd_state != MEI_WD_IDLE) {
|
|
/* timeout */
|
|
ret = -ETIME;
|
|
dev_warn(dev->dev, "wd: stop failed to complete ret=%d\n", ret);
|
|
goto err;
|
|
}
|
|
dev_dbg(dev->dev, "wd: stop completed after %u msec\n",
|
|
MEI_WD_STOP_TIMEOUT - jiffies_to_msecs(ret));
|
|
return 0;
|
|
err:
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* mei_wd_ops_start - wd start command from the watchdog core.
|
|
*
|
|
* @wd_dev: watchdog device struct
|
|
*
|
|
* Return: 0 if success, negative errno code for failure
|
|
*/
|
|
static int mei_wd_ops_start(struct watchdog_device *wd_dev)
|
|
{
|
|
struct mei_device *dev;
|
|
struct mei_cl *cl;
|
|
int err = -ENODEV;
|
|
|
|
dev = watchdog_get_drvdata(wd_dev);
|
|
if (!dev)
|
|
return -ENODEV;
|
|
|
|
cl = &dev->wd_cl;
|
|
|
|
mutex_lock(&dev->device_lock);
|
|
|
|
if (dev->dev_state != MEI_DEV_ENABLED) {
|
|
dev_dbg(dev->dev, "wd: dev_state != MEI_DEV_ENABLED dev_state = %s\n",
|
|
mei_dev_state_str(dev->dev_state));
|
|
goto end_unlock;
|
|
}
|
|
|
|
if (!mei_cl_is_connected(cl)) {
|
|
cl_dbg(dev, cl, "MEI Driver is not connected to Watchdog Client\n");
|
|
goto end_unlock;
|
|
}
|
|
|
|
mei_wd_set_start_timeout(dev, dev->wd_timeout);
|
|
|
|
err = 0;
|
|
end_unlock:
|
|
mutex_unlock(&dev->device_lock);
|
|
return err;
|
|
}
|
|
|
|
/**
|
|
* mei_wd_ops_stop - wd stop command from the watchdog core.
|
|
*
|
|
* @wd_dev: watchdog device struct
|
|
*
|
|
* Return: 0 if success, negative errno code for failure
|
|
*/
|
|
static int mei_wd_ops_stop(struct watchdog_device *wd_dev)
|
|
{
|
|
struct mei_device *dev;
|
|
|
|
dev = watchdog_get_drvdata(wd_dev);
|
|
if (!dev)
|
|
return -ENODEV;
|
|
|
|
mutex_lock(&dev->device_lock);
|
|
mei_wd_stop(dev);
|
|
mutex_unlock(&dev->device_lock);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* mei_wd_ops_ping - wd ping command from the watchdog core.
|
|
*
|
|
* @wd_dev: watchdog device struct
|
|
*
|
|
* Return: 0 if success, negative errno code for failure
|
|
*/
|
|
static int mei_wd_ops_ping(struct watchdog_device *wd_dev)
|
|
{
|
|
struct mei_device *dev;
|
|
struct mei_cl *cl;
|
|
int ret;
|
|
|
|
dev = watchdog_get_drvdata(wd_dev);
|
|
if (!dev)
|
|
return -ENODEV;
|
|
|
|
cl = &dev->wd_cl;
|
|
|
|
mutex_lock(&dev->device_lock);
|
|
|
|
if (!mei_cl_is_connected(cl)) {
|
|
cl_err(dev, cl, "wd: not connected.\n");
|
|
ret = -ENODEV;
|
|
goto end;
|
|
}
|
|
|
|
dev->wd_state = MEI_WD_RUNNING;
|
|
|
|
ret = mei_cl_flow_ctrl_creds(cl);
|
|
if (ret < 0)
|
|
goto end;
|
|
|
|
/* Check if we can send the ping to HW*/
|
|
if (ret && mei_hbuf_acquire(dev)) {
|
|
dev_dbg(dev->dev, "wd: sending ping\n");
|
|
|
|
ret = mei_wd_send(dev);
|
|
if (ret)
|
|
goto end;
|
|
dev->wd_pending = false;
|
|
} else {
|
|
dev->wd_pending = true;
|
|
}
|
|
|
|
end:
|
|
mutex_unlock(&dev->device_lock);
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* mei_wd_ops_set_timeout - wd set timeout command from the watchdog core.
|
|
*
|
|
* @wd_dev: watchdog device struct
|
|
* @timeout: timeout value to set
|
|
*
|
|
* Return: 0 if success, negative errno code for failure
|
|
*/
|
|
static int mei_wd_ops_set_timeout(struct watchdog_device *wd_dev,
|
|
unsigned int timeout)
|
|
{
|
|
struct mei_device *dev;
|
|
|
|
dev = watchdog_get_drvdata(wd_dev);
|
|
if (!dev)
|
|
return -ENODEV;
|
|
|
|
/* Check Timeout value */
|
|
if (timeout < MEI_WD_MIN_TIMEOUT || timeout > MEI_WD_MAX_TIMEOUT)
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&dev->device_lock);
|
|
|
|
dev->wd_timeout = timeout;
|
|
wd_dev->timeout = timeout;
|
|
mei_wd_set_start_timeout(dev, dev->wd_timeout);
|
|
|
|
mutex_unlock(&dev->device_lock);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Watchdog Device structs
|
|
*/
|
|
static const struct watchdog_ops wd_ops = {
|
|
.owner = THIS_MODULE,
|
|
.start = mei_wd_ops_start,
|
|
.stop = mei_wd_ops_stop,
|
|
.ping = mei_wd_ops_ping,
|
|
.set_timeout = mei_wd_ops_set_timeout,
|
|
};
|
|
static const struct watchdog_info wd_info = {
|
|
.identity = INTEL_AMT_WATCHDOG_ID,
|
|
.options = WDIOF_KEEPALIVEPING |
|
|
WDIOF_SETTIMEOUT |
|
|
WDIOF_ALARMONLY,
|
|
};
|
|
|
|
static struct watchdog_device amt_wd_dev = {
|
|
.info = &wd_info,
|
|
.ops = &wd_ops,
|
|
.timeout = MEI_WD_DEFAULT_TIMEOUT,
|
|
.min_timeout = MEI_WD_MIN_TIMEOUT,
|
|
.max_timeout = MEI_WD_MAX_TIMEOUT,
|
|
};
|
|
|
|
|
|
int mei_watchdog_register(struct mei_device *dev)
|
|
{
|
|
|
|
int ret;
|
|
|
|
amt_wd_dev.parent = dev->dev;
|
|
/* unlock to perserve correct locking order */
|
|
mutex_unlock(&dev->device_lock);
|
|
ret = watchdog_register_device(&amt_wd_dev);
|
|
mutex_lock(&dev->device_lock);
|
|
if (ret) {
|
|
dev_err(dev->dev, "wd: unable to register watchdog device = %d.\n",
|
|
ret);
|
|
return ret;
|
|
}
|
|
|
|
dev_dbg(dev->dev, "wd: successfully register watchdog interface.\n");
|
|
watchdog_set_drvdata(&amt_wd_dev, dev);
|
|
return 0;
|
|
}
|
|
|
|
void mei_watchdog_unregister(struct mei_device *dev)
|
|
{
|
|
if (watchdog_get_drvdata(&amt_wd_dev) == NULL)
|
|
return;
|
|
|
|
watchdog_set_drvdata(&amt_wd_dev, NULL);
|
|
watchdog_unregister_device(&amt_wd_dev);
|
|
}
|
|
|