Merge tag 'mfd-for-linus-4.2' of git://git.kernel.org/pub/scm/linux/kernel/git/lee/mfd
Pull MFD updates from Lee Jones: "Changes to existing drivers: - Constify structures; throughout the subsystem - Move support to DT in; cros_ec - DT changes and documentation; cros-ec, max77693, max77686, arizona, da9063 - ACPI changes and documentation; mfd-core - Use different platform specific API in; cros_ec_*, arizona-core - Remove unused parent field from; cros_ec_i2c - Add wake-up/reset delay in; cross_ec_spi, arizona-core - Staticise structures/functions in; cros_ec - Remove redundant code; arizona-core, max77686 - Bugfix; twl4030-power - Allow compile test; aat2870, tps65910 - MAINTAINERS adaptions; samsung, syscon - Resource Management (devm_*); arizona-core - Refactor Reset code; arizona-core - Insist on at least one full boot; arizona-core - Trivial formatting; arizona-core - Add low-power-sleep; arizona-core - IRQ ONESHOT changes; twl4030-irq, mc13xxx-core, wm831x-auxadc, htc-i2cpld, wm8350-core, ab8500-debugfs, ab8500-gpadc, si476x-i2c (Re-)moved drivers: - Move protocol helpers out to drivers/platform; cros_ec New drivers/supported devices: - Add support for AXP22x into axp20x - Add support for OnKey into da9063-core - Add support for Pinctrl into mt6397-core - New STMicroelectronics LPC Watchdog driver - New STMicroelectronics LPC Real-Time Clock driver" * tag 'mfd-for-linus-4.2' of git://git.kernel.org/pub/scm/linux/kernel/git/lee/mfd: (59 commits) mfd: lpc_ich: Assign subdevice ids automatically mfd: si476x-i2c: Pass the IRQF_ONESHOT flag mfd: ab8500-gpadc: Pass the IRQF_ONESHOT flag mfd: ab8500-debugfs: Pass the IRQF_ONESHOT flag mfd: wm8350-core: Pass the IRQF_ONESHOT flag mfd: htc-i2cpld: Pass the IRQF_ONESHOT flag mfd: wm831x-auxadc: Pass the IRQF_ONESHOT flag mfd: mc13xxx-core: Pass the IRQF_ONESHOT flag mfd: twl4030-irq: Pass the IRQF_ONESHOT flag mfd: mt6397-core: Add GPIO sub-module support mfd: arizona: Add convience defines for micd_rate/micd_bias_starttime mfd: dt: Add bindings for DA9063 OnKey mfd: da9063: Add support for OnKey driver mfd: arizona: Fix incorrect Makefile conditionals mfd: arizona: Add stub for wm5102_patch() mfd: Check ACPI device companion before checking resources Documentation: Add WM8998/WM1814 device tree bindings mfd: arizona: Split INx_MODE into two fields mfd: wm5110: Add delay before releasing reset line mfd: arizona: Add better support for system suspend ...
This commit is contained in:
@@ -40,7 +40,7 @@ config CHROMEOS_PSTORE
|
||||
|
||||
config CROS_EC_CHARDEV
|
||||
tristate "Chrome OS Embedded Controller userspace device interface"
|
||||
depends on MFD_CROS_EC
|
||||
depends on CROS_EC_PROTO
|
||||
---help---
|
||||
This driver adds support to talk with the ChromeOS EC from userspace.
|
||||
|
||||
@@ -49,7 +49,7 @@ config CROS_EC_CHARDEV
|
||||
|
||||
config CROS_EC_LPC
|
||||
tristate "ChromeOS Embedded Controller (LPC)"
|
||||
depends on MFD_CROS_EC && (X86 || COMPILE_TEST)
|
||||
depends on MFD_CROS_EC && CROS_EC_PROTO && (X86 || COMPILE_TEST)
|
||||
help
|
||||
If you say Y here, you get support for talking to the ChromeOS EC
|
||||
over an LPC bus. This uses a simple byte-level protocol with a
|
||||
@@ -59,4 +59,9 @@ config CROS_EC_LPC
|
||||
To compile this driver as a module, choose M here: the
|
||||
module will be called cros_ec_lpc.
|
||||
|
||||
config CROS_EC_PROTO
|
||||
bool
|
||||
help
|
||||
ChromeOS EC communication protocol helpers.
|
||||
|
||||
endif # CHROMEOS_PLATFORMS
|
||||
|
@@ -4,3 +4,4 @@ obj-$(CONFIG_CHROMEOS_PSTORE) += chromeos_pstore.o
|
||||
cros_ec_devs-objs := cros_ec_dev.o cros_ec_sysfs.o cros_ec_lightbar.o
|
||||
obj-$(CONFIG_CROS_EC_CHARDEV) += cros_ec_devs.o
|
||||
obj-$(CONFIG_CROS_EC_LPC) += cros_ec_lpc.o
|
||||
obj-$(CONFIG_CROS_EC_PROTO) += cros_ec_proto.o
|
||||
|
@@ -20,44 +20,59 @@
|
||||
#include <linux/fs.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/uaccess.h>
|
||||
|
||||
#include "cros_ec_dev.h"
|
||||
|
||||
/* Device variables */
|
||||
#define CROS_MAX_DEV 128
|
||||
static struct class *cros_class;
|
||||
static int ec_major;
|
||||
|
||||
static const struct attribute_group *cros_ec_groups[] = {
|
||||
&cros_ec_attr_group,
|
||||
&cros_ec_lightbar_attr_group,
|
||||
NULL,
|
||||
};
|
||||
|
||||
static struct class cros_class = {
|
||||
.owner = THIS_MODULE,
|
||||
.name = "chromeos",
|
||||
.dev_groups = cros_ec_groups,
|
||||
};
|
||||
|
||||
/* Basic communication */
|
||||
static int ec_get_version(struct cros_ec_device *ec, char *str, int maxlen)
|
||||
static int ec_get_version(struct cros_ec_dev *ec, char *str, int maxlen)
|
||||
{
|
||||
struct ec_response_get_version *resp;
|
||||
static const char * const current_image_name[] = {
|
||||
"unknown", "read-only", "read-write", "invalid",
|
||||
};
|
||||
struct cros_ec_command msg = {
|
||||
.version = 0,
|
||||
.command = EC_CMD_GET_VERSION,
|
||||
.outdata = { 0 },
|
||||
.outsize = 0,
|
||||
.indata = { 0 },
|
||||
.insize = sizeof(*resp),
|
||||
};
|
||||
struct cros_ec_command *msg;
|
||||
int ret;
|
||||
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
msg = kmalloc(sizeof(*msg) + sizeof(*resp), GFP_KERNEL);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
if (msg.result != EC_RES_SUCCESS) {
|
||||
msg->version = 0;
|
||||
msg->command = EC_CMD_GET_VERSION + ec->cmd_offset;
|
||||
msg->insize = sizeof(*resp);
|
||||
msg->outsize = 0;
|
||||
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
goto exit;
|
||||
|
||||
if (msg->result != EC_RES_SUCCESS) {
|
||||
snprintf(str, maxlen,
|
||||
"%s\nUnknown EC version: EC returned %d\n",
|
||||
CROS_EC_DEV_VERSION, msg.result);
|
||||
return 0;
|
||||
CROS_EC_DEV_VERSION, msg->result);
|
||||
ret = -EINVAL;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
resp = (struct ec_response_get_version *)msg.indata;
|
||||
resp = (struct ec_response_get_version *)msg->data;
|
||||
if (resp->current_image >= ARRAY_SIZE(current_image_name))
|
||||
resp->current_image = 3; /* invalid */
|
||||
|
||||
@@ -65,14 +80,19 @@ static int ec_get_version(struct cros_ec_device *ec, char *str, int maxlen)
|
||||
resp->version_string_ro, resp->version_string_rw,
|
||||
current_image_name[resp->current_image]);
|
||||
|
||||
return 0;
|
||||
ret = 0;
|
||||
exit:
|
||||
kfree(msg);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Device file ops */
|
||||
static int ec_device_open(struct inode *inode, struct file *filp)
|
||||
{
|
||||
filp->private_data = container_of(inode->i_cdev,
|
||||
struct cros_ec_device, cdev);
|
||||
struct cros_ec_dev *ec = container_of(inode->i_cdev,
|
||||
struct cros_ec_dev, cdev);
|
||||
filp->private_data = ec;
|
||||
nonseekable_open(inode, filp);
|
||||
return 0;
|
||||
}
|
||||
|
||||
@@ -84,7 +104,7 @@ static int ec_device_release(struct inode *inode, struct file *filp)
|
||||
static ssize_t ec_device_read(struct file *filp, char __user *buffer,
|
||||
size_t length, loff_t *offset)
|
||||
{
|
||||
struct cros_ec_device *ec = filp->private_data;
|
||||
struct cros_ec_dev *ec = filp->private_data;
|
||||
char msg[sizeof(struct ec_response_get_version) +
|
||||
sizeof(CROS_EC_DEV_VERSION)];
|
||||
size_t count;
|
||||
@@ -107,38 +127,53 @@ static ssize_t ec_device_read(struct file *filp, char __user *buffer,
|
||||
}
|
||||
|
||||
/* Ioctls */
|
||||
static long ec_device_ioctl_xcmd(struct cros_ec_device *ec, void __user *arg)
|
||||
static long ec_device_ioctl_xcmd(struct cros_ec_dev *ec, void __user *arg)
|
||||
{
|
||||
long ret;
|
||||
struct cros_ec_command s_cmd = { };
|
||||
struct cros_ec_command u_cmd;
|
||||
struct cros_ec_command *s_cmd;
|
||||
|
||||
if (copy_from_user(&s_cmd, arg, sizeof(s_cmd)))
|
||||
if (copy_from_user(&u_cmd, arg, sizeof(u_cmd)))
|
||||
return -EFAULT;
|
||||
|
||||
ret = cros_ec_cmd_xfer(ec, &s_cmd);
|
||||
s_cmd = kmalloc(sizeof(*s_cmd) + max(u_cmd.outsize, u_cmd.insize),
|
||||
GFP_KERNEL);
|
||||
if (!s_cmd)
|
||||
return -ENOMEM;
|
||||
|
||||
if (copy_from_user(s_cmd, arg, sizeof(*s_cmd) + u_cmd.outsize)) {
|
||||
ret = -EFAULT;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
s_cmd->command += ec->cmd_offset;
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, s_cmd);
|
||||
/* Only copy data to userland if data was received. */
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
goto exit;
|
||||
|
||||
if (copy_to_user(arg, &s_cmd, sizeof(s_cmd)))
|
||||
return -EFAULT;
|
||||
|
||||
return 0;
|
||||
if (copy_to_user(arg, s_cmd, sizeof(*s_cmd) + u_cmd.insize))
|
||||
ret = -EFAULT;
|
||||
exit:
|
||||
kfree(s_cmd);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static long ec_device_ioctl_readmem(struct cros_ec_device *ec, void __user *arg)
|
||||
static long ec_device_ioctl_readmem(struct cros_ec_dev *ec, void __user *arg)
|
||||
{
|
||||
struct cros_ec_device *ec_dev = ec->ec_dev;
|
||||
struct cros_ec_readmem s_mem = { };
|
||||
long num;
|
||||
|
||||
/* Not every platform supports direct reads */
|
||||
if (!ec->cmd_readmem)
|
||||
if (!ec_dev->cmd_readmem)
|
||||
return -ENOTTY;
|
||||
|
||||
if (copy_from_user(&s_mem, arg, sizeof(s_mem)))
|
||||
return -EFAULT;
|
||||
|
||||
num = ec->cmd_readmem(ec, s_mem.offset, s_mem.bytes, s_mem.buffer);
|
||||
num = ec_dev->cmd_readmem(ec_dev, s_mem.offset, s_mem.bytes,
|
||||
s_mem.buffer);
|
||||
if (num <= 0)
|
||||
return num;
|
||||
|
||||
@@ -151,7 +186,7 @@ static long ec_device_ioctl_readmem(struct cros_ec_device *ec, void __user *arg)
|
||||
static long ec_device_ioctl(struct file *filp, unsigned int cmd,
|
||||
unsigned long arg)
|
||||
{
|
||||
struct cros_ec_device *ec = filp->private_data;
|
||||
struct cros_ec_dev *ec = filp->private_data;
|
||||
|
||||
if (_IOC_TYPE(cmd) != CROS_EC_DEV_IOC)
|
||||
return -ENOTTY;
|
||||
@@ -174,45 +209,81 @@ static const struct file_operations fops = {
|
||||
.unlocked_ioctl = ec_device_ioctl,
|
||||
};
|
||||
|
||||
static void __remove(struct device *dev)
|
||||
{
|
||||
struct cros_ec_dev *ec = container_of(dev, struct cros_ec_dev,
|
||||
class_dev);
|
||||
kfree(ec);
|
||||
}
|
||||
|
||||
static int ec_device_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct cros_ec_device *ec = dev_get_drvdata(pdev->dev.parent);
|
||||
int retval = -ENOTTY;
|
||||
dev_t devno = MKDEV(ec_major, 0);
|
||||
int retval = -ENOMEM;
|
||||
struct device *dev = &pdev->dev;
|
||||
struct cros_ec_platform *ec_platform = dev_get_platdata(dev);
|
||||
dev_t devno = MKDEV(ec_major, pdev->id);
|
||||
struct cros_ec_dev *ec = kzalloc(sizeof(*ec), GFP_KERNEL);
|
||||
|
||||
/* Instantiate it (and remember the EC) */
|
||||
if (!ec)
|
||||
return retval;
|
||||
|
||||
dev_set_drvdata(dev, ec);
|
||||
ec->ec_dev = dev_get_drvdata(dev->parent);
|
||||
ec->dev = dev;
|
||||
ec->cmd_offset = ec_platform->cmd_offset;
|
||||
device_initialize(&ec->class_dev);
|
||||
cdev_init(&ec->cdev, &fops);
|
||||
|
||||
/*
|
||||
* Add the character device
|
||||
* Link cdev to the class device to be sure device is not used
|
||||
* before unbinding it.
|
||||
*/
|
||||
ec->cdev.kobj.parent = &ec->class_dev.kobj;
|
||||
retval = cdev_add(&ec->cdev, devno, 1);
|
||||
if (retval) {
|
||||
dev_err(&pdev->dev, ": failed to add character device\n");
|
||||
return retval;
|
||||
dev_err(dev, ": failed to add character device\n");
|
||||
goto cdev_add_failed;
|
||||
}
|
||||
|
||||
ec->vdev = device_create(cros_class, NULL, devno, ec,
|
||||
CROS_EC_DEV_NAME);
|
||||
if (IS_ERR(ec->vdev)) {
|
||||
retval = PTR_ERR(ec->vdev);
|
||||
dev_err(&pdev->dev, ": failed to create device\n");
|
||||
cdev_del(&ec->cdev);
|
||||
return retval;
|
||||
/*
|
||||
* Add the class device
|
||||
* Link to the character device for creating the /dev entry
|
||||
* in devtmpfs.
|
||||
*/
|
||||
ec->class_dev.devt = ec->cdev.dev;
|
||||
ec->class_dev.class = &cros_class;
|
||||
ec->class_dev.parent = dev;
|
||||
ec->class_dev.release = __remove;
|
||||
|
||||
retval = dev_set_name(&ec->class_dev, "%s", ec_platform->ec_name);
|
||||
if (retval) {
|
||||
dev_err(dev, "dev_set_name failed => %d\n", retval);
|
||||
goto set_named_failed;
|
||||
}
|
||||
|
||||
/* Initialize extra interfaces */
|
||||
ec_dev_sysfs_init(ec);
|
||||
ec_dev_lightbar_init(ec);
|
||||
retval = device_add(&ec->class_dev);
|
||||
if (retval) {
|
||||
dev_err(dev, "device_register failed => %d\n", retval);
|
||||
goto dev_reg_failed;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
dev_reg_failed:
|
||||
set_named_failed:
|
||||
dev_set_drvdata(dev, NULL);
|
||||
cdev_del(&ec->cdev);
|
||||
cdev_add_failed:
|
||||
kfree(ec);
|
||||
return retval;
|
||||
}
|
||||
|
||||
static int ec_device_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct cros_ec_device *ec = dev_get_drvdata(pdev->dev.parent);
|
||||
|
||||
ec_dev_lightbar_remove(ec);
|
||||
ec_dev_sysfs_remove(ec);
|
||||
device_destroy(cros_class, MKDEV(ec_major, 0));
|
||||
struct cros_ec_dev *ec = dev_get_drvdata(&pdev->dev);
|
||||
cdev_del(&ec->cdev);
|
||||
device_unregister(&ec->class_dev);
|
||||
return 0;
|
||||
}
|
||||
|
||||
@@ -229,10 +300,10 @@ static int __init cros_ec_dev_init(void)
|
||||
int ret;
|
||||
dev_t dev = 0;
|
||||
|
||||
cros_class = class_create(THIS_MODULE, "chromeos");
|
||||
if (IS_ERR(cros_class)) {
|
||||
ret = class_register(&cros_class);
|
||||
if (ret) {
|
||||
pr_err(CROS_EC_DEV_NAME ": failed to register device class\n");
|
||||
return PTR_ERR(cros_class);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Get a range of minor numbers (starting with 0) to work with */
|
||||
@@ -254,7 +325,7 @@ static int __init cros_ec_dev_init(void)
|
||||
failed_devreg:
|
||||
unregister_chrdev_region(MKDEV(ec_major, 0), CROS_MAX_DEV);
|
||||
failed_chrdevreg:
|
||||
class_destroy(cros_class);
|
||||
class_unregister(&cros_class);
|
||||
return ret;
|
||||
}
|
||||
|
||||
@@ -262,7 +333,7 @@ static void __exit cros_ec_dev_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&cros_ec_dev_driver);
|
||||
unregister_chrdev(ec_major, CROS_EC_DEV_NAME);
|
||||
class_destroy(cros_class);
|
||||
class_unregister(&cros_class);
|
||||
}
|
||||
|
||||
module_init(cros_ec_dev_init);
|
||||
|
@@ -24,7 +24,6 @@
|
||||
#include <linux/types.h>
|
||||
#include <linux/mfd/cros_ec.h>
|
||||
|
||||
#define CROS_EC_DEV_NAME "cros_ec"
|
||||
#define CROS_EC_DEV_VERSION "1.0.0"
|
||||
|
||||
/*
|
||||
@@ -44,10 +43,4 @@ struct cros_ec_readmem {
|
||||
#define CROS_EC_DEV_IOCXCMD _IOWR(CROS_EC_DEV_IOC, 0, struct cros_ec_command)
|
||||
#define CROS_EC_DEV_IOCRDMEM _IOWR(CROS_EC_DEV_IOC, 1, struct cros_ec_readmem)
|
||||
|
||||
void ec_dev_sysfs_init(struct cros_ec_device *);
|
||||
void ec_dev_sysfs_remove(struct cros_ec_device *);
|
||||
|
||||
void ec_dev_lightbar_init(struct cros_ec_device *);
|
||||
void ec_dev_lightbar_remove(struct cros_ec_device *);
|
||||
|
||||
#endif /* _CROS_EC_DEV_H_ */
|
||||
|
@@ -31,6 +31,7 @@
|
||||
#include <linux/sched.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/uaccess.h>
|
||||
#include <linux/slab.h>
|
||||
|
||||
#include "cros_ec_dev.h"
|
||||
|
||||
@@ -91,55 +92,81 @@ out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
#define INIT_MSG(P, R) { \
|
||||
.command = EC_CMD_LIGHTBAR_CMD, \
|
||||
.outsize = sizeof(*P), \
|
||||
.insize = sizeof(*R), \
|
||||
}
|
||||
static struct cros_ec_command *alloc_lightbar_cmd_msg(struct cros_ec_dev *ec)
|
||||
{
|
||||
struct cros_ec_command *msg;
|
||||
int len;
|
||||
|
||||
static int get_lightbar_version(struct cros_ec_device *ec,
|
||||
len = max(sizeof(struct ec_params_lightbar),
|
||||
sizeof(struct ec_response_lightbar));
|
||||
|
||||
msg = kmalloc(sizeof(*msg) + len, GFP_KERNEL);
|
||||
if (!msg)
|
||||
return NULL;
|
||||
|
||||
msg->version = 0;
|
||||
msg->command = EC_CMD_LIGHTBAR_CMD + ec->cmd_offset;
|
||||
msg->outsize = sizeof(struct ec_params_lightbar);
|
||||
msg->insize = sizeof(struct ec_response_lightbar);
|
||||
|
||||
return msg;
|
||||
}
|
||||
|
||||
static int get_lightbar_version(struct cros_ec_dev *ec,
|
||||
uint32_t *ver_ptr, uint32_t *flg_ptr)
|
||||
{
|
||||
struct ec_params_lightbar *param;
|
||||
struct ec_response_lightbar *resp;
|
||||
struct cros_ec_command msg = INIT_MSG(param, resp);
|
||||
struct cros_ec_command *msg;
|
||||
int ret;
|
||||
|
||||
param = (struct ec_params_lightbar *)msg.outdata;
|
||||
param->cmd = LIGHTBAR_CMD_VERSION;
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
if (ret < 0)
|
||||
msg = alloc_lightbar_cmd_msg(ec);
|
||||
if (!msg)
|
||||
return 0;
|
||||
|
||||
switch (msg.result) {
|
||||
param = (struct ec_params_lightbar *)msg->data;
|
||||
param->cmd = LIGHTBAR_CMD_VERSION;
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0) {
|
||||
ret = 0;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
switch (msg->result) {
|
||||
case EC_RES_INVALID_PARAM:
|
||||
/* Pixel had no version command. */
|
||||
if (ver_ptr)
|
||||
*ver_ptr = 0;
|
||||
if (flg_ptr)
|
||||
*flg_ptr = 0;
|
||||
return 1;
|
||||
ret = 1;
|
||||
goto exit;
|
||||
|
||||
case EC_RES_SUCCESS:
|
||||
resp = (struct ec_response_lightbar *)msg.indata;
|
||||
resp = (struct ec_response_lightbar *)msg->data;
|
||||
|
||||
/* Future devices w/lightbars should implement this command */
|
||||
if (ver_ptr)
|
||||
*ver_ptr = resp->version.num;
|
||||
if (flg_ptr)
|
||||
*flg_ptr = resp->version.flags;
|
||||
return 1;
|
||||
ret = 1;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
/* Anything else (ie, EC_RES_INVALID_COMMAND) - no lightbar */
|
||||
return 0;
|
||||
ret = 0;
|
||||
exit:
|
||||
kfree(msg);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static ssize_t version_show(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
uint32_t version, flags;
|
||||
struct cros_ec_device *ec = dev_get_drvdata(dev);
|
||||
uint32_t version = 0, flags = 0;
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
int ret;
|
||||
|
||||
ret = lb_throttle();
|
||||
@@ -158,30 +185,39 @@ static ssize_t brightness_store(struct device *dev,
|
||||
const char *buf, size_t count)
|
||||
{
|
||||
struct ec_params_lightbar *param;
|
||||
struct ec_response_lightbar *resp;
|
||||
struct cros_ec_command msg = INIT_MSG(param, resp);
|
||||
struct cros_ec_command *msg;
|
||||
int ret;
|
||||
unsigned int val;
|
||||
struct cros_ec_device *ec = dev_get_drvdata(dev);
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
|
||||
if (kstrtouint(buf, 0, &val))
|
||||
return -EINVAL;
|
||||
|
||||
param = (struct ec_params_lightbar *)msg.outdata;
|
||||
param->cmd = LIGHTBAR_CMD_BRIGHTNESS;
|
||||
param->brightness.num = val;
|
||||
msg = alloc_lightbar_cmd_msg(ec);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
param = (struct ec_params_lightbar *)msg->data;
|
||||
param->cmd = LIGHTBAR_CMD_SET_BRIGHTNESS;
|
||||
param->set_brightness.num = val;
|
||||
ret = lb_throttle();
|
||||
if (ret)
|
||||
return ret;
|
||||
goto exit;
|
||||
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
goto exit;
|
||||
|
||||
if (msg.result != EC_RES_SUCCESS)
|
||||
return -EINVAL;
|
||||
if (msg->result != EC_RES_SUCCESS) {
|
||||
ret = -EINVAL;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
return count;
|
||||
ret = count;
|
||||
exit:
|
||||
kfree(msg);
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
@@ -196,12 +232,16 @@ static ssize_t led_rgb_store(struct device *dev, struct device_attribute *attr,
|
||||
const char *buf, size_t count)
|
||||
{
|
||||
struct ec_params_lightbar *param;
|
||||
struct ec_response_lightbar *resp;
|
||||
struct cros_ec_command msg = INIT_MSG(param, resp);
|
||||
struct cros_ec_device *ec = dev_get_drvdata(dev);
|
||||
struct cros_ec_command *msg;
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
unsigned int val[4];
|
||||
int ret, i = 0, j = 0, ok = 0;
|
||||
|
||||
msg = alloc_lightbar_cmd_msg(ec);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
do {
|
||||
/* Skip any whitespace */
|
||||
while (*buf && isspace(*buf))
|
||||
@@ -215,12 +255,12 @@ static ssize_t led_rgb_store(struct device *dev, struct device_attribute *attr,
|
||||
return -EINVAL;
|
||||
|
||||
if (i == 4) {
|
||||
param = (struct ec_params_lightbar *)msg.outdata;
|
||||
param->cmd = LIGHTBAR_CMD_RGB;
|
||||
param->rgb.led = val[0];
|
||||
param->rgb.red = val[1];
|
||||
param->rgb.green = val[2];
|
||||
param->rgb.blue = val[3];
|
||||
param = (struct ec_params_lightbar *)msg->data;
|
||||
param->cmd = LIGHTBAR_CMD_SET_RGB;
|
||||
param->set_rgb.led = val[0];
|
||||
param->set_rgb.red = val[1];
|
||||
param->set_rgb.green = val[2];
|
||||
param->set_rgb.blue = val[3];
|
||||
/*
|
||||
* Throttle only the first of every four transactions,
|
||||
* so that the user can update all four LEDs at once.
|
||||
@@ -231,12 +271,14 @@ static ssize_t led_rgb_store(struct device *dev, struct device_attribute *attr,
|
||||
return ret;
|
||||
}
|
||||
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
goto exit;
|
||||
|
||||
if (msg.result != EC_RES_SUCCESS)
|
||||
return -EINVAL;
|
||||
if (msg->result != EC_RES_SUCCESS) {
|
||||
ret = -EINVAL;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
i = 0;
|
||||
ok = 1;
|
||||
@@ -248,6 +290,8 @@ static ssize_t led_rgb_store(struct device *dev, struct device_attribute *attr,
|
||||
|
||||
} while (*buf);
|
||||
|
||||
exit:
|
||||
kfree(msg);
|
||||
return (ok && i == 0) ? count : -EINVAL;
|
||||
}
|
||||
|
||||
@@ -261,41 +305,56 @@ static ssize_t sequence_show(struct device *dev,
|
||||
{
|
||||
struct ec_params_lightbar *param;
|
||||
struct ec_response_lightbar *resp;
|
||||
struct cros_ec_command msg = INIT_MSG(param, resp);
|
||||
struct cros_ec_command *msg;
|
||||
int ret;
|
||||
struct cros_ec_device *ec = dev_get_drvdata(dev);
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
|
||||
param = (struct ec_params_lightbar *)msg.outdata;
|
||||
msg = alloc_lightbar_cmd_msg(ec);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
param = (struct ec_params_lightbar *)msg->data;
|
||||
param->cmd = LIGHTBAR_CMD_GET_SEQ;
|
||||
ret = lb_throttle();
|
||||
if (ret)
|
||||
return ret;
|
||||
goto exit;
|
||||
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
goto exit;
|
||||
|
||||
if (msg.result != EC_RES_SUCCESS)
|
||||
return scnprintf(buf, PAGE_SIZE,
|
||||
"ERROR: EC returned %d\n", msg.result);
|
||||
if (msg->result != EC_RES_SUCCESS) {
|
||||
ret = scnprintf(buf, PAGE_SIZE,
|
||||
"ERROR: EC returned %d\n", msg->result);
|
||||
goto exit;
|
||||
}
|
||||
|
||||
resp = (struct ec_response_lightbar *)msg.indata;
|
||||
resp = (struct ec_response_lightbar *)msg->data;
|
||||
if (resp->get_seq.num >= ARRAY_SIZE(seqname))
|
||||
return scnprintf(buf, PAGE_SIZE, "%d\n", resp->get_seq.num);
|
||||
ret = scnprintf(buf, PAGE_SIZE, "%d\n", resp->get_seq.num);
|
||||
else
|
||||
return scnprintf(buf, PAGE_SIZE, "%s\n",
|
||||
seqname[resp->get_seq.num]);
|
||||
ret = scnprintf(buf, PAGE_SIZE, "%s\n",
|
||||
seqname[resp->get_seq.num]);
|
||||
|
||||
exit:
|
||||
kfree(msg);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static ssize_t sequence_store(struct device *dev, struct device_attribute *attr,
|
||||
const char *buf, size_t count)
|
||||
{
|
||||
struct ec_params_lightbar *param;
|
||||
struct ec_response_lightbar *resp;
|
||||
struct cros_ec_command msg = INIT_MSG(param, resp);
|
||||
struct cros_ec_command *msg;
|
||||
unsigned int num;
|
||||
int ret, len;
|
||||
struct cros_ec_device *ec = dev_get_drvdata(dev);
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
|
||||
msg = alloc_lightbar_cmd_msg(ec);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
for (len = 0; len < count; len++)
|
||||
if (!isalnum(buf[len]))
|
||||
@@ -311,18 +370,18 @@ static ssize_t sequence_store(struct device *dev, struct device_attribute *attr,
|
||||
return ret;
|
||||
}
|
||||
|
||||
param = (struct ec_params_lightbar *)msg.outdata;
|
||||
param = (struct ec_params_lightbar *)msg->data;
|
||||
param->cmd = LIGHTBAR_CMD_SEQ;
|
||||
param->seq.num = num;
|
||||
ret = lb_throttle();
|
||||
if (ret)
|
||||
return ret;
|
||||
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
|
||||
if (msg.result != EC_RES_SUCCESS)
|
||||
if (msg->result != EC_RES_SUCCESS)
|
||||
return -EINVAL;
|
||||
|
||||
return count;
|
||||
@@ -343,25 +402,27 @@ static struct attribute *__lb_cmds_attrs[] = {
|
||||
&dev_attr_sequence.attr,
|
||||
NULL,
|
||||
};
|
||||
static struct attribute_group lb_cmds_attr_group = {
|
||||
.name = "lightbar",
|
||||
.attrs = __lb_cmds_attrs,
|
||||
};
|
||||
|
||||
void ec_dev_lightbar_init(struct cros_ec_device *ec)
|
||||
static umode_t cros_ec_lightbar_attrs_are_visible(struct kobject *kobj,
|
||||
struct attribute *a, int n)
|
||||
{
|
||||
int ret = 0;
|
||||
struct device *dev = container_of(kobj, struct device, kobj);
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
struct platform_device *pdev = container_of(ec->dev,
|
||||
struct platform_device, dev);
|
||||
if (pdev->id != 0)
|
||||
return 0;
|
||||
|
||||
/* Only instantiate this stuff if the EC has a lightbar */
|
||||
if (!get_lightbar_version(ec, NULL, NULL))
|
||||
return;
|
||||
|
||||
ret = sysfs_create_group(&ec->vdev->kobj, &lb_cmds_attr_group);
|
||||
if (ret)
|
||||
pr_warn("sysfs_create_group() failed: %d\n", ret);
|
||||
if (get_lightbar_version(ec, NULL, NULL))
|
||||
return a->mode;
|
||||
else
|
||||
return 0;
|
||||
}
|
||||
|
||||
void ec_dev_lightbar_remove(struct cros_ec_device *ec)
|
||||
{
|
||||
sysfs_remove_group(&ec->vdev->kobj, &lb_cmds_attr_group);
|
||||
}
|
||||
struct attribute_group cros_ec_lightbar_attr_group = {
|
||||
.name = "lightbar",
|
||||
.attrs = __lb_cmds_attrs,
|
||||
.is_visible = cros_ec_lightbar_attrs_are_visible,
|
||||
};
|
||||
|
@@ -46,6 +46,77 @@ static int ec_response_timed_out(void)
|
||||
return 1;
|
||||
}
|
||||
|
||||
static int cros_ec_pkt_xfer_lpc(struct cros_ec_device *ec,
|
||||
struct cros_ec_command *msg)
|
||||
{
|
||||
struct ec_host_request *request;
|
||||
struct ec_host_response response;
|
||||
u8 sum = 0;
|
||||
int i;
|
||||
int ret = 0;
|
||||
u8 *dout;
|
||||
|
||||
ret = cros_ec_prepare_tx(ec, msg);
|
||||
|
||||
/* Write buffer */
|
||||
for (i = 0; i < ret; i++)
|
||||
outb(ec->dout[i], EC_LPC_ADDR_HOST_PACKET + i);
|
||||
|
||||
request = (struct ec_host_request *)ec->dout;
|
||||
|
||||
/* Here we go */
|
||||
outb(EC_COMMAND_PROTOCOL_3, EC_LPC_ADDR_HOST_CMD);
|
||||
|
||||
if (ec_response_timed_out()) {
|
||||
dev_warn(ec->dev, "EC responsed timed out\n");
|
||||
ret = -EIO;
|
||||
goto done;
|
||||
}
|
||||
|
||||
/* Check result */
|
||||
msg->result = inb(EC_LPC_ADDR_HOST_DATA);
|
||||
ret = cros_ec_check_result(ec, msg);
|
||||
if (ret)
|
||||
goto done;
|
||||
|
||||
/* Read back response */
|
||||
dout = (u8 *)&response;
|
||||
for (i = 0; i < sizeof(response); i++) {
|
||||
dout[i] = inb(EC_LPC_ADDR_HOST_PACKET + i);
|
||||
sum += dout[i];
|
||||
}
|
||||
|
||||
msg->result = response.result;
|
||||
|
||||
if (response.data_len > msg->insize) {
|
||||
dev_err(ec->dev,
|
||||
"packet too long (%d bytes, expected %d)",
|
||||
response.data_len, msg->insize);
|
||||
ret = -EMSGSIZE;
|
||||
goto done;
|
||||
}
|
||||
|
||||
/* Read response and process checksum */
|
||||
for (i = 0; i < response.data_len; i++) {
|
||||
msg->data[i] =
|
||||
inb(EC_LPC_ADDR_HOST_PACKET + sizeof(response) + i);
|
||||
sum += msg->data[i];
|
||||
}
|
||||
|
||||
if (sum) {
|
||||
dev_err(ec->dev,
|
||||
"bad packet checksum %02x\n",
|
||||
response.checksum);
|
||||
ret = -EBADMSG;
|
||||
goto done;
|
||||
}
|
||||
|
||||
/* Return actual amount of data received */
|
||||
ret = response.data_len;
|
||||
done:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int cros_ec_cmd_xfer_lpc(struct cros_ec_device *ec,
|
||||
struct cros_ec_command *msg)
|
||||
{
|
||||
@@ -73,8 +144,8 @@ static int cros_ec_cmd_xfer_lpc(struct cros_ec_device *ec,
|
||||
|
||||
/* Copy data and update checksum */
|
||||
for (i = 0; i < msg->outsize; i++) {
|
||||
outb(msg->outdata[i], EC_LPC_ADDR_HOST_PARAM + i);
|
||||
csum += msg->outdata[i];
|
||||
outb(msg->data[i], EC_LPC_ADDR_HOST_PARAM + i);
|
||||
csum += msg->data[i];
|
||||
}
|
||||
|
||||
/* Finalize checksum and write args */
|
||||
@@ -129,8 +200,8 @@ static int cros_ec_cmd_xfer_lpc(struct cros_ec_device *ec,
|
||||
|
||||
/* Read response and update checksum */
|
||||
for (i = 0; i < args.data_size; i++) {
|
||||
msg->indata[i] = inb(EC_LPC_ADDR_HOST_PARAM + i);
|
||||
csum += msg->indata[i];
|
||||
msg->data[i] = inb(EC_LPC_ADDR_HOST_PARAM + i);
|
||||
csum += msg->data[i];
|
||||
}
|
||||
|
||||
/* Verify checksum */
|
||||
@@ -212,11 +283,13 @@ static int cros_ec_lpc_probe(struct platform_device *pdev)
|
||||
|
||||
platform_set_drvdata(pdev, ec_dev);
|
||||
ec_dev->dev = dev;
|
||||
ec_dev->ec_name = pdev->name;
|
||||
ec_dev->phys_name = dev_name(dev);
|
||||
ec_dev->parent = dev;
|
||||
ec_dev->cmd_xfer = cros_ec_cmd_xfer_lpc;
|
||||
ec_dev->pkt_xfer = cros_ec_pkt_xfer_lpc;
|
||||
ec_dev->cmd_readmem = cros_ec_lpc_readmem;
|
||||
ec_dev->din_size = sizeof(struct ec_host_response) +
|
||||
sizeof(struct ec_response_get_protocol_info);
|
||||
ec_dev->dout_size = sizeof(struct ec_host_request);
|
||||
|
||||
ret = cros_ec_register(ec_dev);
|
||||
if (ret) {
|
||||
|
382
drivers/platform/chrome/cros_ec_proto.c
Normal file
382
drivers/platform/chrome/cros_ec_proto.c
Normal file
@@ -0,0 +1,382 @@
|
||||
/*
|
||||
* ChromeOS EC communication protocol helper functions
|
||||
*
|
||||
* Copyright (C) 2015 Google, Inc
|
||||
*
|
||||
* This software is licensed under the terms of the GNU General Public
|
||||
* License version 2, as published by the Free Software Foundation, and
|
||||
* may be copied, distributed, and modified under those terms.
|
||||
*
|
||||
* This program 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 General Public License for more details.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/mfd/cros_ec.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/slab.h>
|
||||
|
||||
#define EC_COMMAND_RETRIES 50
|
||||
|
||||
static int prepare_packet(struct cros_ec_device *ec_dev,
|
||||
struct cros_ec_command *msg)
|
||||
{
|
||||
struct ec_host_request *request;
|
||||
u8 *out;
|
||||
int i;
|
||||
u8 csum = 0;
|
||||
|
||||
BUG_ON(ec_dev->proto_version != EC_HOST_REQUEST_VERSION);
|
||||
BUG_ON(msg->outsize + sizeof(*request) > ec_dev->dout_size);
|
||||
|
||||
out = ec_dev->dout;
|
||||
request = (struct ec_host_request *)out;
|
||||
request->struct_version = EC_HOST_REQUEST_VERSION;
|
||||
request->checksum = 0;
|
||||
request->command = msg->command;
|
||||
request->command_version = msg->version;
|
||||
request->reserved = 0;
|
||||
request->data_len = msg->outsize;
|
||||
|
||||
for (i = 0; i < sizeof(*request); i++)
|
||||
csum += out[i];
|
||||
|
||||
/* Copy data and update checksum */
|
||||
memcpy(out + sizeof(*request), msg->data, msg->outsize);
|
||||
for (i = 0; i < msg->outsize; i++)
|
||||
csum += msg->data[i];
|
||||
|
||||
request->checksum = -csum;
|
||||
|
||||
return sizeof(*request) + msg->outsize;
|
||||
}
|
||||
|
||||
static int send_command(struct cros_ec_device *ec_dev,
|
||||
struct cros_ec_command *msg)
|
||||
{
|
||||
int ret;
|
||||
|
||||
if (ec_dev->proto_version > 2)
|
||||
ret = ec_dev->pkt_xfer(ec_dev, msg);
|
||||
else
|
||||
ret = ec_dev->cmd_xfer(ec_dev, msg);
|
||||
|
||||
if (msg->result == EC_RES_IN_PROGRESS) {
|
||||
int i;
|
||||
struct cros_ec_command *status_msg;
|
||||
struct ec_response_get_comms_status *status;
|
||||
|
||||
status_msg = kmalloc(sizeof(*status_msg) + sizeof(*status),
|
||||
GFP_KERNEL);
|
||||
if (!status_msg)
|
||||
return -ENOMEM;
|
||||
|
||||
status_msg->version = 0;
|
||||
status_msg->command = EC_CMD_GET_COMMS_STATUS;
|
||||
status_msg->insize = sizeof(*status);
|
||||
status_msg->outsize = 0;
|
||||
|
||||
/*
|
||||
* Query the EC's status until it's no longer busy or
|
||||
* we encounter an error.
|
||||
*/
|
||||
for (i = 0; i < EC_COMMAND_RETRIES; i++) {
|
||||
usleep_range(10000, 11000);
|
||||
|
||||
ret = ec_dev->cmd_xfer(ec_dev, status_msg);
|
||||
if (ret < 0)
|
||||
break;
|
||||
|
||||
msg->result = status_msg->result;
|
||||
if (status_msg->result != EC_RES_SUCCESS)
|
||||
break;
|
||||
|
||||
status = (struct ec_response_get_comms_status *)
|
||||
status_msg->data;
|
||||
if (!(status->flags & EC_COMMS_STATUS_PROCESSING))
|
||||
break;
|
||||
}
|
||||
|
||||
kfree(status_msg);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int cros_ec_prepare_tx(struct cros_ec_device *ec_dev,
|
||||
struct cros_ec_command *msg)
|
||||
{
|
||||
u8 *out;
|
||||
u8 csum;
|
||||
int i;
|
||||
|
||||
if (ec_dev->proto_version > 2)
|
||||
return prepare_packet(ec_dev, msg);
|
||||
|
||||
BUG_ON(msg->outsize > EC_PROTO2_MAX_PARAM_SIZE);
|
||||
out = ec_dev->dout;
|
||||
out[0] = EC_CMD_VERSION0 + msg->version;
|
||||
out[1] = msg->command;
|
||||
out[2] = msg->outsize;
|
||||
csum = out[0] + out[1] + out[2];
|
||||
for (i = 0; i < msg->outsize; i++)
|
||||
csum += out[EC_MSG_TX_HEADER_BYTES + i] = msg->data[i];
|
||||
out[EC_MSG_TX_HEADER_BYTES + msg->outsize] = csum;
|
||||
|
||||
return EC_MSG_TX_PROTO_BYTES + msg->outsize;
|
||||
}
|
||||
EXPORT_SYMBOL(cros_ec_prepare_tx);
|
||||
|
||||
int cros_ec_check_result(struct cros_ec_device *ec_dev,
|
||||
struct cros_ec_command *msg)
|
||||
{
|
||||
switch (msg->result) {
|
||||
case EC_RES_SUCCESS:
|
||||
return 0;
|
||||
case EC_RES_IN_PROGRESS:
|
||||
dev_dbg(ec_dev->dev, "command 0x%02x in progress\n",
|
||||
msg->command);
|
||||
return -EAGAIN;
|
||||
default:
|
||||
dev_dbg(ec_dev->dev, "command 0x%02x returned %d\n",
|
||||
msg->command, msg->result);
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
EXPORT_SYMBOL(cros_ec_check_result);
|
||||
|
||||
static int cros_ec_host_command_proto_query(struct cros_ec_device *ec_dev,
|
||||
int devidx,
|
||||
struct cros_ec_command *msg)
|
||||
{
|
||||
/*
|
||||
* Try using v3+ to query for supported protocols. If this
|
||||
* command fails, fall back to v2. Returns the highest protocol
|
||||
* supported by the EC.
|
||||
* Also sets the max request/response/passthru size.
|
||||
*/
|
||||
int ret;
|
||||
|
||||
if (!ec_dev->pkt_xfer)
|
||||
return -EPROTONOSUPPORT;
|
||||
|
||||
memset(msg, 0, sizeof(*msg));
|
||||
msg->command = EC_CMD_PASSTHRU_OFFSET(devidx) | EC_CMD_GET_PROTOCOL_INFO;
|
||||
msg->insize = sizeof(struct ec_response_get_protocol_info);
|
||||
|
||||
ret = send_command(ec_dev, msg);
|
||||
|
||||
if (ret < 0) {
|
||||
dev_dbg(ec_dev->dev,
|
||||
"failed to check for EC[%d] protocol version: %d\n",
|
||||
devidx, ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
if (devidx > 0 && msg->result == EC_RES_INVALID_COMMAND)
|
||||
return -ENODEV;
|
||||
else if (msg->result != EC_RES_SUCCESS)
|
||||
return msg->result;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int cros_ec_host_command_proto_query_v2(struct cros_ec_device *ec_dev)
|
||||
{
|
||||
struct cros_ec_command *msg;
|
||||
struct ec_params_hello *hello_params;
|
||||
struct ec_response_hello *hello_response;
|
||||
int ret;
|
||||
int len = max(sizeof(*hello_params), sizeof(*hello_response));
|
||||
|
||||
msg = kmalloc(sizeof(*msg) + len, GFP_KERNEL);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
msg->version = 0;
|
||||
msg->command = EC_CMD_HELLO;
|
||||
hello_params = (struct ec_params_hello *)msg->data;
|
||||
msg->outsize = sizeof(*hello_params);
|
||||
hello_response = (struct ec_response_hello *)msg->data;
|
||||
msg->insize = sizeof(*hello_response);
|
||||
|
||||
hello_params->in_data = 0xa0b0c0d0;
|
||||
|
||||
ret = send_command(ec_dev, msg);
|
||||
|
||||
if (ret < 0) {
|
||||
dev_dbg(ec_dev->dev,
|
||||
"EC failed to respond to v2 hello: %d\n",
|
||||
ret);
|
||||
goto exit;
|
||||
} else if (msg->result != EC_RES_SUCCESS) {
|
||||
dev_err(ec_dev->dev,
|
||||
"EC responded to v2 hello with error: %d\n",
|
||||
msg->result);
|
||||
ret = msg->result;
|
||||
goto exit;
|
||||
} else if (hello_response->out_data != 0xa1b2c3d4) {
|
||||
dev_err(ec_dev->dev,
|
||||
"EC responded to v2 hello with bad result: %u\n",
|
||||
hello_response->out_data);
|
||||
ret = -EBADMSG;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
ret = 0;
|
||||
|
||||
exit:
|
||||
kfree(msg);
|
||||
return ret;
|
||||
}
|
||||
|
||||
int cros_ec_query_all(struct cros_ec_device *ec_dev)
|
||||
{
|
||||
struct device *dev = ec_dev->dev;
|
||||
struct cros_ec_command *proto_msg;
|
||||
struct ec_response_get_protocol_info *proto_info;
|
||||
int ret;
|
||||
|
||||
proto_msg = kzalloc(sizeof(*proto_msg) + sizeof(*proto_info),
|
||||
GFP_KERNEL);
|
||||
if (!proto_msg)
|
||||
return -ENOMEM;
|
||||
|
||||
/* First try sending with proto v3. */
|
||||
ec_dev->proto_version = 3;
|
||||
ret = cros_ec_host_command_proto_query(ec_dev, 0, proto_msg);
|
||||
|
||||
if (ret == 0) {
|
||||
proto_info = (struct ec_response_get_protocol_info *)
|
||||
proto_msg->data;
|
||||
ec_dev->max_request = proto_info->max_request_packet_size -
|
||||
sizeof(struct ec_host_request);
|
||||
ec_dev->max_response = proto_info->max_response_packet_size -
|
||||
sizeof(struct ec_host_response);
|
||||
ec_dev->proto_version =
|
||||
min(EC_HOST_REQUEST_VERSION,
|
||||
fls(proto_info->protocol_versions) - 1);
|
||||
dev_dbg(ec_dev->dev,
|
||||
"using proto v%u\n",
|
||||
ec_dev->proto_version);
|
||||
|
||||
ec_dev->din_size = ec_dev->max_response +
|
||||
sizeof(struct ec_host_response) +
|
||||
EC_MAX_RESPONSE_OVERHEAD;
|
||||
ec_dev->dout_size = ec_dev->max_request +
|
||||
sizeof(struct ec_host_request) +
|
||||
EC_MAX_REQUEST_OVERHEAD;
|
||||
|
||||
/*
|
||||
* Check for PD
|
||||
*/
|
||||
ret = cros_ec_host_command_proto_query(ec_dev, 1, proto_msg);
|
||||
|
||||
if (ret) {
|
||||
dev_dbg(ec_dev->dev, "no PD chip found: %d\n", ret);
|
||||
ec_dev->max_passthru = 0;
|
||||
} else {
|
||||
dev_dbg(ec_dev->dev, "found PD chip\n");
|
||||
ec_dev->max_passthru =
|
||||
proto_info->max_request_packet_size -
|
||||
sizeof(struct ec_host_request);
|
||||
}
|
||||
} else {
|
||||
/* Try querying with a v2 hello message. */
|
||||
ec_dev->proto_version = 2;
|
||||
ret = cros_ec_host_command_proto_query_v2(ec_dev);
|
||||
|
||||
if (ret == 0) {
|
||||
/* V2 hello succeeded. */
|
||||
dev_dbg(ec_dev->dev, "falling back to proto v2\n");
|
||||
|
||||
ec_dev->max_request = EC_PROTO2_MAX_PARAM_SIZE;
|
||||
ec_dev->max_response = EC_PROTO2_MAX_PARAM_SIZE;
|
||||
ec_dev->max_passthru = 0;
|
||||
ec_dev->pkt_xfer = NULL;
|
||||
ec_dev->din_size = EC_MSG_BYTES;
|
||||
ec_dev->dout_size = EC_MSG_BYTES;
|
||||
} else {
|
||||
/*
|
||||
* It's possible for a test to occur too early when
|
||||
* the EC isn't listening. If this happens, we'll
|
||||
* test later when the first command is run.
|
||||
*/
|
||||
ec_dev->proto_version = EC_PROTO_VERSION_UNKNOWN;
|
||||
dev_dbg(ec_dev->dev, "EC query failed: %d\n", ret);
|
||||
goto exit;
|
||||
}
|
||||
}
|
||||
|
||||
devm_kfree(dev, ec_dev->din);
|
||||
devm_kfree(dev, ec_dev->dout);
|
||||
|
||||
ec_dev->din = devm_kzalloc(dev, ec_dev->din_size, GFP_KERNEL);
|
||||
if (!ec_dev->din) {
|
||||
ret = -ENOMEM;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
ec_dev->dout = devm_kzalloc(dev, ec_dev->dout_size, GFP_KERNEL);
|
||||
if (!ec_dev->dout) {
|
||||
devm_kfree(dev, ec_dev->din);
|
||||
ret = -ENOMEM;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
exit:
|
||||
kfree(proto_msg);
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL(cros_ec_query_all);
|
||||
|
||||
int cros_ec_cmd_xfer(struct cros_ec_device *ec_dev,
|
||||
struct cros_ec_command *msg)
|
||||
{
|
||||
int ret;
|
||||
|
||||
mutex_lock(&ec_dev->lock);
|
||||
if (ec_dev->proto_version == EC_PROTO_VERSION_UNKNOWN) {
|
||||
ret = cros_ec_query_all(ec_dev);
|
||||
if (ret) {
|
||||
dev_err(ec_dev->dev,
|
||||
"EC version unknown and query failed; aborting command\n");
|
||||
mutex_unlock(&ec_dev->lock);
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
if (msg->insize > ec_dev->max_response) {
|
||||
dev_dbg(ec_dev->dev, "clamping message receive buffer\n");
|
||||
msg->insize = ec_dev->max_response;
|
||||
}
|
||||
|
||||
if (msg->command < EC_CMD_PASSTHRU_OFFSET(1)) {
|
||||
if (msg->outsize > ec_dev->max_request) {
|
||||
dev_err(ec_dev->dev,
|
||||
"request of size %u is too big (max: %u)\n",
|
||||
msg->outsize,
|
||||
ec_dev->max_request);
|
||||
mutex_unlock(&ec_dev->lock);
|
||||
return -EMSGSIZE;
|
||||
}
|
||||
} else {
|
||||
if (msg->outsize > ec_dev->max_passthru) {
|
||||
dev_err(ec_dev->dev,
|
||||
"passthru rq of size %u is too big (max: %u)\n",
|
||||
msg->outsize,
|
||||
ec_dev->max_passthru);
|
||||
mutex_unlock(&ec_dev->lock);
|
||||
return -EMSGSIZE;
|
||||
}
|
||||
}
|
||||
ret = send_command(ec_dev, msg);
|
||||
mutex_unlock(&ec_dev->lock);
|
||||
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL(cros_ec_cmd_xfer);
|
@@ -29,6 +29,7 @@
|
||||
#include <linux/module.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/printk.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/stat.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/uaccess.h>
|
||||
@@ -66,13 +67,19 @@ static ssize_t store_ec_reboot(struct device *dev,
|
||||
{"hibernate", EC_REBOOT_HIBERNATE, 0},
|
||||
{"at-shutdown", -1, EC_REBOOT_FLAG_ON_AP_SHUTDOWN},
|
||||
};
|
||||
struct cros_ec_command msg = { 0 };
|
||||
struct ec_params_reboot_ec *param =
|
||||
(struct ec_params_reboot_ec *)msg.outdata;
|
||||
struct cros_ec_command *msg;
|
||||
struct ec_params_reboot_ec *param;
|
||||
int got_cmd = 0, offset = 0;
|
||||
int i;
|
||||
int ret;
|
||||
struct cros_ec_device *ec = dev_get_drvdata(dev);
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
|
||||
msg = kmalloc(sizeof(*msg) + sizeof(*param), GFP_KERNEL);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
param = (struct ec_params_reboot_ec *)msg->data;
|
||||
|
||||
param->flags = 0;
|
||||
while (1) {
|
||||
@@ -100,19 +107,26 @@ static ssize_t store_ec_reboot(struct device *dev,
|
||||
offset++;
|
||||
}
|
||||
|
||||
if (!got_cmd)
|
||||
return -EINVAL;
|
||||
|
||||
msg.command = EC_CMD_REBOOT_EC;
|
||||
msg.outsize = sizeof(param);
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
if (msg.result != EC_RES_SUCCESS) {
|
||||
dev_dbg(ec->dev, "EC result %d\n", msg.result);
|
||||
return -EINVAL;
|
||||
if (!got_cmd) {
|
||||
count = -EINVAL;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
msg->version = 0;
|
||||
msg->command = EC_CMD_REBOOT_EC + ec->cmd_offset;
|
||||
msg->outsize = sizeof(*param);
|
||||
msg->insize = 0;
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0) {
|
||||
count = ret;
|
||||
goto exit;
|
||||
}
|
||||
if (msg->result != EC_RES_SUCCESS) {
|
||||
dev_dbg(ec->dev, "EC result %d\n", msg->result);
|
||||
count = -EINVAL;
|
||||
}
|
||||
exit:
|
||||
kfree(msg);
|
||||
return count;
|
||||
}
|
||||
|
||||
@@ -123,22 +137,33 @@ static ssize_t show_ec_version(struct device *dev,
|
||||
struct ec_response_get_version *r_ver;
|
||||
struct ec_response_get_chip_info *r_chip;
|
||||
struct ec_response_board_version *r_board;
|
||||
struct cros_ec_command msg = { 0 };
|
||||
struct cros_ec_command *msg;
|
||||
int ret;
|
||||
int count = 0;
|
||||
struct cros_ec_device *ec = dev_get_drvdata(dev);
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
|
||||
msg = kmalloc(sizeof(*msg) + EC_HOST_PARAM_SIZE, GFP_KERNEL);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
/* Get versions. RW may change. */
|
||||
msg.command = EC_CMD_GET_VERSION;
|
||||
msg.insize = sizeof(*r_ver);
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
if (msg.result != EC_RES_SUCCESS)
|
||||
return scnprintf(buf, PAGE_SIZE,
|
||||
"ERROR: EC returned %d\n", msg.result);
|
||||
msg->version = 0;
|
||||
msg->command = EC_CMD_GET_VERSION + ec->cmd_offset;
|
||||
msg->insize = sizeof(*r_ver);
|
||||
msg->outsize = 0;
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0) {
|
||||
count = ret;
|
||||
goto exit;
|
||||
}
|
||||
if (msg->result != EC_RES_SUCCESS) {
|
||||
count = scnprintf(buf, PAGE_SIZE,
|
||||
"ERROR: EC returned %d\n", msg->result);
|
||||
goto exit;
|
||||
}
|
||||
|
||||
r_ver = (struct ec_response_get_version *)msg.indata;
|
||||
r_ver = (struct ec_response_get_version *)msg->data;
|
||||
/* Strings should be null-terminated, but let's be sure. */
|
||||
r_ver->version_string_ro[sizeof(r_ver->version_string_ro) - 1] = '\0';
|
||||
r_ver->version_string_rw[sizeof(r_ver->version_string_rw) - 1] = '\0';
|
||||
@@ -152,33 +177,33 @@ static ssize_t show_ec_version(struct device *dev,
|
||||
image_names[r_ver->current_image] : "?"));
|
||||
|
||||
/* Get build info. */
|
||||
msg.command = EC_CMD_GET_BUILD_INFO;
|
||||
msg.insize = sizeof(msg.indata);
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
msg->command = EC_CMD_GET_BUILD_INFO + ec->cmd_offset;
|
||||
msg->insize = EC_HOST_PARAM_SIZE;
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
count += scnprintf(buf + count, PAGE_SIZE - count,
|
||||
"Build info: XFER ERROR %d\n", ret);
|
||||
else if (msg.result != EC_RES_SUCCESS)
|
||||
else if (msg->result != EC_RES_SUCCESS)
|
||||
count += scnprintf(buf + count, PAGE_SIZE - count,
|
||||
"Build info: EC error %d\n", msg.result);
|
||||
"Build info: EC error %d\n", msg->result);
|
||||
else {
|
||||
msg.indata[sizeof(msg.indata) - 1] = '\0';
|
||||
msg->data[sizeof(msg->data) - 1] = '\0';
|
||||
count += scnprintf(buf + count, PAGE_SIZE - count,
|
||||
"Build info: %s\n", msg.indata);
|
||||
"Build info: %s\n", msg->data);
|
||||
}
|
||||
|
||||
/* Get chip info. */
|
||||
msg.command = EC_CMD_GET_CHIP_INFO;
|
||||
msg.insize = sizeof(*r_chip);
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
msg->command = EC_CMD_GET_CHIP_INFO + ec->cmd_offset;
|
||||
msg->insize = sizeof(*r_chip);
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
count += scnprintf(buf + count, PAGE_SIZE - count,
|
||||
"Chip info: XFER ERROR %d\n", ret);
|
||||
else if (msg.result != EC_RES_SUCCESS)
|
||||
else if (msg->result != EC_RES_SUCCESS)
|
||||
count += scnprintf(buf + count, PAGE_SIZE - count,
|
||||
"Chip info: EC error %d\n", msg.result);
|
||||
"Chip info: EC error %d\n", msg->result);
|
||||
else {
|
||||
r_chip = (struct ec_response_get_chip_info *)msg.indata;
|
||||
r_chip = (struct ec_response_get_chip_info *)msg->data;
|
||||
|
||||
r_chip->vendor[sizeof(r_chip->vendor) - 1] = '\0';
|
||||
r_chip->name[sizeof(r_chip->name) - 1] = '\0';
|
||||
@@ -192,23 +217,25 @@ static ssize_t show_ec_version(struct device *dev,
|
||||
}
|
||||
|
||||
/* Get board version */
|
||||
msg.command = EC_CMD_GET_BOARD_VERSION;
|
||||
msg.insize = sizeof(*r_board);
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
msg->command = EC_CMD_GET_BOARD_VERSION + ec->cmd_offset;
|
||||
msg->insize = sizeof(*r_board);
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
count += scnprintf(buf + count, PAGE_SIZE - count,
|
||||
"Board version: XFER ERROR %d\n", ret);
|
||||
else if (msg.result != EC_RES_SUCCESS)
|
||||
else if (msg->result != EC_RES_SUCCESS)
|
||||
count += scnprintf(buf + count, PAGE_SIZE - count,
|
||||
"Board version: EC error %d\n", msg.result);
|
||||
"Board version: EC error %d\n", msg->result);
|
||||
else {
|
||||
r_board = (struct ec_response_board_version *)msg.indata;
|
||||
r_board = (struct ec_response_board_version *)msg->data;
|
||||
|
||||
count += scnprintf(buf + count, PAGE_SIZE - count,
|
||||
"Board version: %d\n",
|
||||
r_board->board_version);
|
||||
}
|
||||
|
||||
exit:
|
||||
kfree(msg);
|
||||
return count;
|
||||
}
|
||||
|
||||
@@ -216,27 +243,39 @@ static ssize_t show_ec_flashinfo(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
struct ec_response_flash_info *resp;
|
||||
struct cros_ec_command msg = { 0 };
|
||||
struct cros_ec_command *msg;
|
||||
int ret;
|
||||
struct cros_ec_device *ec = dev_get_drvdata(dev);
|
||||
struct cros_ec_dev *ec = container_of(dev,
|
||||
struct cros_ec_dev, class_dev);
|
||||
|
||||
msg = kmalloc(sizeof(*msg) + sizeof(*resp), GFP_KERNEL);
|
||||
if (!msg)
|
||||
return -ENOMEM;
|
||||
|
||||
/* The flash info shouldn't ever change, but ask each time anyway. */
|
||||
msg.command = EC_CMD_FLASH_INFO;
|
||||
msg.insize = sizeof(*resp);
|
||||
ret = cros_ec_cmd_xfer(ec, &msg);
|
||||
msg->version = 0;
|
||||
msg->command = EC_CMD_FLASH_INFO + ec->cmd_offset;
|
||||
msg->insize = sizeof(*resp);
|
||||
msg->outsize = 0;
|
||||
ret = cros_ec_cmd_xfer(ec->ec_dev, msg);
|
||||
if (ret < 0)
|
||||
return ret;
|
||||
if (msg.result != EC_RES_SUCCESS)
|
||||
return scnprintf(buf, PAGE_SIZE,
|
||||
"ERROR: EC returned %d\n", msg.result);
|
||||
goto exit;
|
||||
if (msg->result != EC_RES_SUCCESS) {
|
||||
ret = scnprintf(buf, PAGE_SIZE,
|
||||
"ERROR: EC returned %d\n", msg->result);
|
||||
goto exit;
|
||||
}
|
||||
|
||||
resp = (struct ec_response_flash_info *)msg.indata;
|
||||
resp = (struct ec_response_flash_info *)msg->data;
|
||||
|
||||
return scnprintf(buf, PAGE_SIZE,
|
||||
"FlashSize %d\nWriteSize %d\n"
|
||||
"EraseSize %d\nProtectSize %d\n",
|
||||
resp->flash_size, resp->write_block_size,
|
||||
resp->erase_block_size, resp->protect_block_size);
|
||||
ret = scnprintf(buf, PAGE_SIZE,
|
||||
"FlashSize %d\nWriteSize %d\n"
|
||||
"EraseSize %d\nProtectSize %d\n",
|
||||
resp->flash_size, resp->write_block_size,
|
||||
resp->erase_block_size, resp->protect_block_size);
|
||||
exit:
|
||||
kfree(msg);
|
||||
return ret;
|
||||
}
|
||||
|
||||
/* Module initialization */
|
||||
@@ -252,20 +291,7 @@ static struct attribute *__ec_attrs[] = {
|
||||
NULL,
|
||||
};
|
||||
|
||||
static struct attribute_group ec_attr_group = {
|
||||
struct attribute_group cros_ec_attr_group = {
|
||||
.attrs = __ec_attrs,
|
||||
};
|
||||
|
||||
void ec_dev_sysfs_init(struct cros_ec_device *ec)
|
||||
{
|
||||
int error;
|
||||
|
||||
error = sysfs_create_group(&ec->vdev->kobj, &ec_attr_group);
|
||||
if (error)
|
||||
pr_warn("failed to create group: %d\n", error);
|
||||
}
|
||||
|
||||
void ec_dev_sysfs_remove(struct cros_ec_device *ec)
|
||||
{
|
||||
sysfs_remove_group(&ec->vdev->kobj, &ec_attr_group);
|
||||
}
|
||||
|
Reference in New Issue
Block a user