drivers/platform/chrome/cros_ec_debugfs.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 // Debug logs for the ChromeOS EC
   3 //
   4 // Copyright (C) 2015 Google, Inc.
   5
   6 #include <linux/circ_buf.h>
   7 #include <linux/debugfs.h>
   8 #include <linux/delay.h>
   9 #include <linux/fs.h>
  10 #include <linux/mod_devicetable.h>
  11 #include <linux/module.h>
  12 #include <linux/mutex.h>
  13 #include <linux/platform_data/cros_ec_commands.h>
  14 #include <linux/platform_data/cros_ec_proto.h>
  15 #include <linux/platform_device.h>
  16 #include <linux/poll.h>
  17 #include <linux/sched.h>
  18 #include <linux/slab.h>
  19 #include <linux/wait.h>
  20
  21 #define DRV_NAME "cros-ec-debugfs"
  22
  23 #define LOG_SHIFT               14
  24 #define LOG_SIZE                (1 << LOG_SHIFT)
  25 #define LOG_POLL_SEC            10
  26
  27 #define CIRC_ADD(idx, size, value)      (((idx) + (value)) & ((size) - 1))
  28
  29 static unsigned int log_poll_period_ms = LOG_POLL_SEC * MSEC_PER_SEC;
  30 module_param(log_poll_period_ms, uint, 0644);
  31 MODULE_PARM_DESC(log_poll_period_ms, "EC log polling period(ms)");
  32
  33 /* waitqueue for log readers */
  34 static DECLARE_WAIT_QUEUE_HEAD(cros_ec_debugfs_log_wq);
  35
  36 /**
  37  * struct cros_ec_debugfs - EC debugging information.
  38  *
  39  * @ec: EC device this debugfs information belongs to
  40  * @dir: dentry for debugfs files
  41  * @log_buffer: circular buffer for console log information
  42  * @read_msg: preallocated EC command and buffer to read console log
  43  * @log_mutex: mutex to protect circular buffer
  44  * @log_poll_work: recurring task to poll EC for new console log data
  45  * @panicinfo_blob: panicinfo debugfs blob
  46  * @notifier_panic: notifier_block to let kernel to flush buffered log
  47  *                  when EC panic
  48  */
  49 struct cros_ec_debugfs {
  50         struct cros_ec_dev *ec;
  51         struct dentry *dir;
  52         /* EC log */
  53         struct circ_buf log_buffer;
  54         struct cros_ec_command *read_msg;
  55         struct mutex log_mutex;
  56         struct delayed_work log_poll_work;
  57         /* EC panicinfo */
  58         struct debugfs_blob_wrapper panicinfo_blob;
  59         struct notifier_block notifier_panic;
  60 };
  61
  62 /*
  63  * We need to make sure that the EC log buffer on the UART is large enough,
  64  * so that it is unlikely enough to overlow within log_poll_period_ms.
  65  */
  66 static void cros_ec_console_log_work(struct work_struct *__work)
  67 {
  68         struct cros_ec_debugfs *debug_info =
  69                 container_of(to_delayed_work(__work),
  70                              struct cros_ec_debugfs,
  71                              log_poll_work);
  72         struct cros_ec_dev *ec = debug_info->ec;
  73         struct circ_buf *cb = &debug_info->log_buffer;
  74         struct cros_ec_command snapshot_msg = {
  75                 .command = EC_CMD_CONSOLE_SNAPSHOT + ec->cmd_offset,
  76         };
  77
  78         struct ec_params_console_read_v1 *read_params =
  79                 (struct ec_params_console_read_v1 *)debug_info->read_msg->data;
  80         uint8_t *ec_buffer = (uint8_t *)debug_info->read_msg->data;
  81         int idx;
  82         int buf_space;
  83         int ret;
  84
  85         ret = cros_ec_cmd_xfer_status(ec->ec_dev, &snapshot_msg);
  86         if (ret < 0)
  87                 goto resched;
  88
  89         /* Loop until we have read everything, or there's an error. */
  90         mutex_lock(&debug_info->log_mutex);
  91         buf_space = CIRC_SPACE(cb->head, cb->tail, LOG_SIZE);
  92
  93         while (1) {
  94                 if (!buf_space) {
  95                         dev_info_once(ec->dev,
  96                                       "Some logs may have been dropped...\n");
  97                         break;
  98                 }
  99
 100                 memset(read_params, '\0', sizeof(*read_params));
 101                 read_params->subcmd = CONSOLE_READ_RECENT;
 102                 ret = cros_ec_cmd_xfer_status(ec->ec_dev,
 103                                               debug_info->read_msg);
 104                 if (ret < 0)
 105                         break;
 106
 107                 /* If the buffer is empty, we're done here. */
 108                 if (ret == 0 || ec_buffer[0] == '\0')
 109                         break;
 110
 111                 idx = 0;
 112                 while (idx < ret && ec_buffer[idx] != '\0' && buf_space > 0) {
 113                         cb->buf[cb->head] = ec_buffer[idx];
 114                         cb->head = CIRC_ADD(cb->head, LOG_SIZE, 1);
 115                         idx++;
 116                         buf_space--;
 117                 }
 118
 119                 wake_up(&cros_ec_debugfs_log_wq);
 120         }
 121
 122         mutex_unlock(&debug_info->log_mutex);
 123
 124 resched:
 125         schedule_delayed_work(&debug_info->log_poll_work,
 126                               msecs_to_jiffies(log_poll_period_ms));
 127 }
 128
 129 static int cros_ec_console_log_open(struct inode *inode, struct file *file)
 130 {
 131         file->private_data = inode->i_private;
 132
 133         return stream_open(inode, file);
 134 }
 135
 136 static ssize_t cros_ec_console_log_read(struct file *file, char __user *buf,
 137                                         size_t count, loff_t *ppos)
 138 {
 139         struct cros_ec_debugfs *debug_info = file->private_data;
 140         struct circ_buf *cb = &debug_info->log_buffer;
 141         ssize_t ret;
 142
 143         mutex_lock(&debug_info->log_mutex);
 144
 145         while (!CIRC_CNT(cb->head, cb->tail, LOG_SIZE)) {
 146                 if (file->f_flags & O_NONBLOCK) {
 147                         ret = -EAGAIN;
 148                         goto error;
 149                 }
 150
 151                 mutex_unlock(&debug_info->log_mutex);
 152
 153                 ret = wait_event_interruptible(cros_ec_debugfs_log_wq,
 154                                         CIRC_CNT(cb->head, cb->tail, LOG_SIZE));
 155                 if (ret < 0)
 156                         return ret;
 157
 158                 mutex_lock(&debug_info->log_mutex);
 159         }
 160
 161         /* Only copy until the end of the circular buffer, and let userspace
 162          * retry to get the rest of the data.
 163          */
 164         ret = min_t(size_t, CIRC_CNT_TO_END(cb->head, cb->tail, LOG_SIZE),
 165                     count);
 166
 167         if (copy_to_user(buf, cb->buf + cb->tail, ret)) {
 168                 ret = -EFAULT;
 169                 goto error;
 170         }
 171
 172         cb->tail = CIRC_ADD(cb->tail, LOG_SIZE, ret);
 173
 174 error:
 175         mutex_unlock(&debug_info->log_mutex);
 176         return ret;
 177 }
 178
 179 static __poll_t cros_ec_console_log_poll(struct file *file,
 180                                              poll_table *wait)
 181 {
 182         struct cros_ec_debugfs *debug_info = file->private_data;
 183         __poll_t mask = 0;
 184
 185         poll_wait(file, &cros_ec_debugfs_log_wq, wait);
 186
 187         mutex_lock(&debug_info->log_mutex);
 188         if (CIRC_CNT(debug_info->log_buffer.head,
 189                      debug_info->log_buffer.tail,
 190                      LOG_SIZE))
 191                 mask |= EPOLLIN | EPOLLRDNORM;
 192         mutex_unlock(&debug_info->log_mutex);
 193
 194         return mask;
 195 }
 196
 197 static int cros_ec_console_log_release(struct inode *inode, struct file *file)
 198 {
 199         return 0;
 200 }
 201
 202 static ssize_t cros_ec_pdinfo_read(struct file *file,
 203                                    char __user *user_buf,
 204                                    size_t count,
 205                                    loff_t *ppos)
 206 {
 207         char read_buf[EC_USB_PD_MAX_PORTS * 40], *p = read_buf;
 208         struct cros_ec_debugfs *debug_info = file->private_data;
 209         struct cros_ec_device *ec_dev = debug_info->ec->ec_dev;
 210         struct {
 211                 struct cros_ec_command msg;
 212                 union {
 213                         struct ec_response_usb_pd_control_v1 resp;
 214                         struct ec_params_usb_pd_control params;
 215                 };
 216         } __packed ec_buf;
 217         struct cros_ec_command *msg;
 218         struct ec_response_usb_pd_control_v1 *resp;
 219         struct ec_params_usb_pd_control *params;
 220         int i;
 221
 222         msg = &ec_buf.msg;
 223         params = (struct ec_params_usb_pd_control *)msg->data;
 224         resp = (struct ec_response_usb_pd_control_v1 *)msg->data;
 225
 226         msg->command = EC_CMD_USB_PD_CONTROL;
 227         msg->version = 1;
 228         msg->insize = sizeof(*resp);
 229         msg->outsize = sizeof(*params);
 230
 231         /*
 232          * Read status from all PD ports until failure, typically caused
 233          * by attempting to read status on a port that doesn't exist.
 234          */
 235         for (i = 0; i < EC_USB_PD_MAX_PORTS; ++i) {
 236                 params->port = i;
 237                 params->role = 0;
 238                 params->mux = 0;
 239                 params->swap = 0;
 240
 241                 if (cros_ec_cmd_xfer_status(ec_dev, msg) < 0)
 242                         break;
 243
 244                 p += scnprintf(p, sizeof(read_buf) + read_buf - p,
 245                                "p%d: %s en:%.2x role:%.2x pol:%.2x\n", i,
 246                                resp->state, resp->enabled, resp->role,
 247                                resp->polarity);
 248         }
 249
 250         return simple_read_from_buffer(user_buf, count, ppos,
 251                                        read_buf, p - read_buf);
 252 }
 253
 254 static bool cros_ec_uptime_is_supported(struct cros_ec_device *ec_dev)
 255 {
 256         struct {
 257                 struct cros_ec_command cmd;
 258                 struct ec_response_uptime_info resp;
 259         } __packed msg = {};
 260         int ret;
 261
 262         msg.cmd.command = EC_CMD_GET_UPTIME_INFO;
 263         msg.cmd.insize = sizeof(msg.resp);
 264
 265         ret = cros_ec_cmd_xfer_status(ec_dev, &msg.cmd);
 266         if (ret == -EPROTO && msg.cmd.result == EC_RES_INVALID_COMMAND)
 267                 return false;
 268
 269         /* Other errors maybe a transient error, do not rule about support. */
 270         return true;
 271 }
 272
 273 static ssize_t cros_ec_uptime_read(struct file *file, char __user *user_buf,
 274                                    size_t count, loff_t *ppos)
 275 {
 276         struct cros_ec_debugfs *debug_info = file->private_data;
 277         struct cros_ec_device *ec_dev = debug_info->ec->ec_dev;
 278         struct {
 279                 struct cros_ec_command cmd;
 280                 struct ec_response_uptime_info resp;
 281         } __packed msg = {};
 282         struct ec_response_uptime_info *resp;
 283         char read_buf[32];
 284         int ret;
 285
 286         resp = (struct ec_response_uptime_info *)&msg.resp;
 287
 288         msg.cmd.command = EC_CMD_GET_UPTIME_INFO;
 289         msg.cmd.insize = sizeof(*resp);
 290
 291         ret = cros_ec_cmd_xfer_status(ec_dev, &msg.cmd);
 292         if (ret < 0)
 293                 return ret;
 294
 295         ret = scnprintf(read_buf, sizeof(read_buf), "%u\n",
 296                         resp->time_since_ec_boot_ms);
 297
 298         return simple_read_from_buffer(user_buf, count, ppos, read_buf, ret);
 299 }
 300
 301 static const struct file_operations cros_ec_console_log_fops = {
 302         .owner = THIS_MODULE,
 303         .open = cros_ec_console_log_open,
 304         .read = cros_ec_console_log_read,
 305         .llseek = no_llseek,
 306         .poll = cros_ec_console_log_poll,
 307         .release = cros_ec_console_log_release,
 308 };
 309
 310 static const struct file_operations cros_ec_pdinfo_fops = {
 311         .owner = THIS_MODULE,
 312         .open = simple_open,
 313         .read = cros_ec_pdinfo_read,
 314         .llseek = default_llseek,
 315 };
 316
 317 static const struct file_operations cros_ec_uptime_fops = {
 318         .owner = THIS_MODULE,
 319         .open = simple_open,
 320         .read = cros_ec_uptime_read,
 321         .llseek = default_llseek,
 322 };
 323
 324 static int ec_read_version_supported(struct cros_ec_dev *ec)
 325 {
 326         struct ec_params_get_cmd_versions_v1 *params;
 327         struct ec_response_get_cmd_versions *response;
 328         int ret;
 329
 330         struct cros_ec_command *msg;
 331
 332         msg = kzalloc(sizeof(*msg) + max(sizeof(*params), sizeof(*response)),
 333                 GFP_KERNEL);
 334         if (!msg)
 335                 return 0;
 336
 337         msg->version = 1;
 338         msg->command = EC_CMD_GET_CMD_VERSIONS + ec->cmd_offset;
 339         msg->outsize = sizeof(*params);
 340         msg->insize = sizeof(*response);
 341
 342         params = (struct ec_params_get_cmd_versions_v1 *)msg->data;
 343         params->cmd = EC_CMD_CONSOLE_READ;
 344         response = (struct ec_response_get_cmd_versions *)msg->data;
 345
 346         ret = cros_ec_cmd_xfer_status(ec->ec_dev, msg) >= 0 &&
 347               response->version_mask & EC_VER_MASK(1);
 348
 349         kfree(msg);
 350
 351         return ret;
 352 }
 353
 354 static int cros_ec_create_console_log(struct cros_ec_debugfs *debug_info)
 355 {
 356         struct cros_ec_dev *ec = debug_info->ec;
 357         char *buf;
 358         int read_params_size;
 359         int read_response_size;
 360
 361         /*
 362          * If the console log feature is not supported return silently and
 363          * don't create the console_log entry.
 364          */
 365         if (!ec_read_version_supported(ec))
 366                 return 0;
 367
 368         buf = devm_kzalloc(ec->dev, LOG_SIZE, GFP_KERNEL);
 369         if (!buf)
 370                 return -ENOMEM;
 371
 372         read_params_size = sizeof(struct ec_params_console_read_v1);
 373         read_response_size = ec->ec_dev->max_response;
 374         debug_info->read_msg = devm_kzalloc(ec->dev,
 375                 sizeof(*debug_info->read_msg) +
 376                         max(read_params_size, read_response_size), GFP_KERNEL);
 377         if (!debug_info->read_msg)
 378                 return -ENOMEM;
 379
 380         debug_info->read_msg->version = 1;
 381         debug_info->read_msg->command = EC_CMD_CONSOLE_READ + ec->cmd_offset;
 382         debug_info->read_msg->outsize = read_params_size;
 383         debug_info->read_msg->insize = read_response_size;
 384
 385         debug_info->log_buffer.buf = buf;
 386         debug_info->log_buffer.head = 0;
 387         debug_info->log_buffer.tail = 0;
 388
 389         mutex_init(&debug_info->log_mutex);
 390
 391         debugfs_create_file("console_log", S_IFREG | 0444, debug_info->dir,
 392                             debug_info, &cros_ec_console_log_fops);
 393
 394         INIT_DELAYED_WORK(&debug_info->log_poll_work,
 395                           cros_ec_console_log_work);
 396         schedule_delayed_work(&debug_info->log_poll_work, 0);
 397
 398         return 0;
 399 }
 400
 401 static void cros_ec_cleanup_console_log(struct cros_ec_debugfs *debug_info)
 402 {
 403         if (debug_info->log_buffer.buf) {
 404                 cancel_delayed_work_sync(&debug_info->log_poll_work);
 405                 mutex_destroy(&debug_info->log_mutex);
 406         }
 407 }
 408
 409 /*
 410  * Returns the size of the panicinfo data fetched from the EC
 411  */
 412 static int cros_ec_get_panicinfo(struct cros_ec_device *ec_dev, uint8_t *data,
 413                                  int data_size)
 414 {
 415         int ret;
 416         struct cros_ec_command *msg;
 417
 418         if (!data || data_size <= 0 || data_size > ec_dev->max_response)
 419                 return -EINVAL;
 420
 421         msg = kzalloc(sizeof(*msg) + data_size, GFP_KERNEL);
 422         if (!msg)
 423                 return -ENOMEM;
 424
 425         msg->command = EC_CMD_GET_PANIC_INFO;
 426         msg->insize = data_size;
 427
 428         ret = cros_ec_cmd_xfer_status(ec_dev, msg);
 429         if (ret < 0)
 430                 goto free;
 431
 432         memcpy(data, msg->data, data_size);
 433
 434 free:
 435         kfree(msg);
 436         return ret;
 437 }
 438
 439 static int cros_ec_create_panicinfo(struct cros_ec_debugfs *debug_info)
 440 {
 441         struct cros_ec_device *ec_dev = debug_info->ec->ec_dev;
 442         int ret;
 443         void *data;
 444
 445         data = devm_kzalloc(debug_info->ec->dev, ec_dev->max_response,
 446                             GFP_KERNEL);
 447         if (!data)
 448                 return -ENOMEM;
 449
 450         ret = cros_ec_get_panicinfo(ec_dev, data, ec_dev->max_response);
 451         if (ret < 0) {
 452                 ret = 0;
 453                 goto free;
 454         }
 455
 456         /* No panic data */
 457         if (ret == 0)
 458                 goto free;
 459
 460         debug_info->panicinfo_blob.data = data;
 461         debug_info->panicinfo_blob.size = ret;
 462
 463         debugfs_create_blob("panicinfo", 0444, debug_info->dir,
 464                             &debug_info->panicinfo_blob);
 465
 466         return 0;
 467
 468 free:
 469         devm_kfree(debug_info->ec->dev, data);
 470         return ret;
 471 }
 472
 473 static int cros_ec_debugfs_panic_event(struct notifier_block *nb,
 474                                        unsigned long queued_during_suspend, void *_notify)
 475 {
 476         struct cros_ec_debugfs *debug_info =
 477                 container_of(nb, struct cros_ec_debugfs, notifier_panic);
 478
 479         if (debug_info->log_buffer.buf) {
 480                 /* Force log poll work to run immediately */
 481                 mod_delayed_work(debug_info->log_poll_work.wq, &debug_info->log_poll_work, 0);
 482                 /* Block until log poll work finishes */
 483                 flush_delayed_work(&debug_info->log_poll_work);
 484         }
 485
 486         return NOTIFY_DONE;
 487 }
 488
 489 static int cros_ec_debugfs_probe(struct platform_device *pd)
 490 {
 491         struct cros_ec_dev *ec = dev_get_drvdata(pd->dev.parent);
 492         struct cros_ec_platform *ec_platform = dev_get_platdata(ec->dev);
 493         const char *name = ec_platform->ec_name;
 494         struct cros_ec_debugfs *debug_info;
 495         int ret;
 496
 497         debug_info = devm_kzalloc(ec->dev, sizeof(*debug_info), GFP_KERNEL);
 498         if (!debug_info)
 499                 return -ENOMEM;
 500
 501         debug_info->ec = ec;
 502         debug_info->dir = debugfs_create_dir(name, NULL);
 503
 504         ret = cros_ec_create_panicinfo(debug_info);
 505         if (ret)
 506                 goto remove_debugfs;
 507
 508         ret = cros_ec_create_console_log(debug_info);
 509         if (ret)
 510                 goto remove_debugfs;
 511
 512         debugfs_create_file("pdinfo", 0444, debug_info->dir, debug_info,
 513                             &cros_ec_pdinfo_fops);
 514
 515         if (cros_ec_uptime_is_supported(ec->ec_dev))
 516                 debugfs_create_file("uptime", 0444, debug_info->dir, debug_info,
 517                                     &cros_ec_uptime_fops);
 518
 519         debugfs_create_x32("last_resume_result", 0444, debug_info->dir,
 520                            &ec->ec_dev->last_resume_result);
 521
 522         debugfs_create_u16("suspend_timeout_ms", 0664, debug_info->dir,
 523                            &ec->ec_dev->suspend_timeout_ms);
 524
 525         debug_info->notifier_panic.notifier_call = cros_ec_debugfs_panic_event;
 526         ret = blocking_notifier_chain_register(&ec->ec_dev->panic_notifier,
 527                                                &debug_info->notifier_panic);
 528         if (ret)
 529                 goto remove_debugfs;
 530
 531         ec->debug_info = debug_info;
 532
 533         dev_set_drvdata(&pd->dev, ec);
 534
 535         return 0;
 536
 537 remove_debugfs:
 538         debugfs_remove_recursive(debug_info->dir);
 539         return ret;
 540 }
 541
 542 static void cros_ec_debugfs_remove(struct platform_device *pd)
 543 {
 544         struct cros_ec_dev *ec = dev_get_drvdata(pd->dev.parent);
 545
 546         debugfs_remove_recursive(ec->debug_info->dir);
 547         cros_ec_cleanup_console_log(ec->debug_info);
 548 }
 549
 550 static int __maybe_unused cros_ec_debugfs_suspend(struct device *dev)
 551 {
 552         struct cros_ec_dev *ec = dev_get_drvdata(dev);
 553
 554         if (ec->debug_info->log_buffer.buf)
 555                 cancel_delayed_work_sync(&ec->debug_info->log_poll_work);
 556
 557         return 0;
 558 }
 559
 560 static int __maybe_unused cros_ec_debugfs_resume(struct device *dev)
 561 {
 562         struct cros_ec_dev *ec = dev_get_drvdata(dev);
 563
 564         if (ec->debug_info->log_buffer.buf)
 565                 schedule_delayed_work(&ec->debug_info->log_poll_work, 0);
 566
 567         return 0;
 568 }
 569
 570 static SIMPLE_DEV_PM_OPS(cros_ec_debugfs_pm_ops,
 571                          cros_ec_debugfs_suspend, cros_ec_debugfs_resume);
 572
 573 static const struct platform_device_id cros_ec_debugfs_id[] = {
 574         { DRV_NAME, 0 },
 575         {}
 576 };
 577 MODULE_DEVICE_TABLE(platform, cros_ec_debugfs_id);
 578
 579 static struct platform_driver cros_ec_debugfs_driver = {
 580         .driver = {
 581                 .name = DRV_NAME,
 582                 .pm = &cros_ec_debugfs_pm_ops,
 583                 .probe_type = PROBE_PREFER_ASYNCHRONOUS,
 584         },
 585         .probe = cros_ec_debugfs_probe,
 586         .remove_new = cros_ec_debugfs_remove,
 587         .id_table = cros_ec_debugfs_id,
 588 };
 589
 590 module_platform_driver(cros_ec_debugfs_driver);
 591
 592 MODULE_LICENSE("GPL");
 593 MODULE_DESCRIPTION("Debug logs for ChromeOS EC");