*/
static bool has_manual_suspend;
+/*
+ * Lightbar version
+ */
+static int lb_version;
+
static ssize_t interval_msec_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
static struct cros_ec_command *alloc_lightbar_cmd_msg(struct cros_ec_dev *ec)
{
+ int len = max(ec->ec_dev->max_response, ec->ec_dev->max_request);
struct cros_ec_command *msg;
- int len;
-
- len = max(sizeof(struct ec_params_lightbar),
- sizeof(struct ec_response_lightbar));
msg = kmalloc(sizeof(*msg) + len, GFP_KERNEL);
if (!msg)
msg->version = 0;
msg->command = EC_CMD_LIGHTBAR_CMD + ec->cmd_offset;
+ /*
+ * Default sizes for regular commands.
+ * Can be set smaller to optimize transfer,
+ * larger when sending large light sequences.
+ */
msg->outsize = sizeof(struct ec_params_lightbar);
msg->insize = sizeof(struct ec_response_lightbar);
static ssize_t program_store(struct device *dev, struct device_attribute *attr,
const char *buf, size_t count)
{
- int extra_bytes, max_size, ret;
+ size_t extra_bytes, max_size;
struct ec_params_lightbar *param;
struct cros_ec_command *msg;
struct cros_ec_dev *ec = to_cros_ec_dev(dev);
+ int ret;
/*
* We might need to reject the program for size reasons. The EC
* and send a program that is too big for the protocol. In order
* to ensure the latter, we also need to ensure we have extra bytes
* to represent the rest of the packet.
+ * With V3, larger program can be sent, limited only by the EC.
+ * Only the protocol limit the payload size.
*/
- extra_bytes = sizeof(*param) - sizeof(param->set_program.data);
- max_size = min(EC_LB_PROG_LEN, ec->ec_dev->max_request - extra_bytes);
- if (count > max_size) {
- dev_err(dev, "Program is %u bytes, too long to send (max: %u)",
- (unsigned int)count, max_size);
-
- return -EINVAL;
+ if (lb_version < 3) {
+ extra_bytes = sizeof(*param) - sizeof(param->set_program.data);
+ max_size = min(EC_LB_PROG_LEN, ec->ec_dev->max_request - extra_bytes);
+ if (count > max_size) {
+ dev_err(dev, "Program is %zu bytes, too long to send (max: %zu)",
+ count, max_size);
+
+ return -EINVAL;
+ }
+ } else {
+ extra_bytes = offsetof(typeof(*param), set_program_ex) +
+ sizeof(param->set_program_ex);
+ max_size = ec->ec_dev->max_request - extra_bytes;
}
msg = alloc_lightbar_cmd_msg(ec);
ret = lb_throttle();
if (ret)
goto exit;
+ param = (struct ec_params_lightbar *)msg->data;
- dev_info(dev, "Copying %zu byte program to EC", count);
+ if (lb_version < 3) {
+ dev_info(dev, "Copying %zu byte program to EC", count);
- param = (struct ec_params_lightbar *)msg->data;
- param->cmd = LIGHTBAR_CMD_SET_PROGRAM;
+ param->cmd = LIGHTBAR_CMD_SET_PROGRAM;
- param->set_program.size = count;
- memcpy(param->set_program.data, buf, count);
+ param->set_program.size = count;
+ memcpy(param->set_program.data, buf, count);
- /*
- * We need to set the message size manually or else it will use
- * EC_LB_PROG_LEN. This might be too long, and the program
- * is unlikely to use all of the space.
- */
- msg->outsize = count + extra_bytes;
+ /*
+ * We need to set the message size manually or else it will use
+ * EC_LB_PROG_LEN. This might be too long, and the program
+ * is unlikely to use all of the space.
+ */
+ msg->outsize = count + extra_bytes;
- ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
- if (ret < 0)
- goto exit;
+ ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
+ if (ret < 0)
+ goto exit;
+ } else {
+ size_t offset = 0;
+ size_t payload = 0;
+
+ param->cmd = LIGHTBAR_CMD_SET_PROGRAM_EX;
+ while (offset < count) {
+ payload = min(max_size, count - offset);
+ param->set_program_ex.offset = offset;
+ param->set_program_ex.size = payload;
+ memcpy(param->set_program_ex.data, &buf[offset], payload);
+ msg->outsize = payload + extra_bytes;
+ ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg);
+ if (ret < 0)
+ goto exit;
+ offset += payload;
+ }
+ }
ret = count;
exit:
kfree(msg);
* Ask then for the lightbar version, if it's 0 then the 'cros_ec'
* doesn't have a lightbar.
*/
- if (!get_lightbar_version(ec_dev, NULL, NULL))
+ if (!get_lightbar_version(ec_dev, &lb_version, NULL))
return -ENODEV;
/* Take control of the lightbar from the EC. */