162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * debugfs attributes for Wilco EC 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright 2019 Google LLC 662306a36Sopenharmony_ci * 762306a36Sopenharmony_ci * See Documentation/ABI/testing/debugfs-wilco-ec for usage. 862306a36Sopenharmony_ci */ 962306a36Sopenharmony_ci 1062306a36Sopenharmony_ci#include <linux/ctype.h> 1162306a36Sopenharmony_ci#include <linux/debugfs.h> 1262306a36Sopenharmony_ci#include <linux/fs.h> 1362306a36Sopenharmony_ci#include <linux/module.h> 1462306a36Sopenharmony_ci#include <linux/platform_data/wilco-ec.h> 1562306a36Sopenharmony_ci#include <linux/platform_device.h> 1662306a36Sopenharmony_ci 1762306a36Sopenharmony_ci#define DRV_NAME "wilco-ec-debugfs" 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci/* The raw bytes will take up more space when represented as a hex string */ 2062306a36Sopenharmony_ci#define FORMATTED_BUFFER_SIZE (EC_MAILBOX_DATA_SIZE * 4) 2162306a36Sopenharmony_ci 2262306a36Sopenharmony_cistruct wilco_ec_debugfs { 2362306a36Sopenharmony_ci struct wilco_ec_device *ec; 2462306a36Sopenharmony_ci struct dentry *dir; 2562306a36Sopenharmony_ci size_t response_size; 2662306a36Sopenharmony_ci u8 raw_data[EC_MAILBOX_DATA_SIZE]; 2762306a36Sopenharmony_ci u8 formatted_data[FORMATTED_BUFFER_SIZE]; 2862306a36Sopenharmony_ci}; 2962306a36Sopenharmony_cistatic struct wilco_ec_debugfs *debug_info; 3062306a36Sopenharmony_ci 3162306a36Sopenharmony_ci/** 3262306a36Sopenharmony_ci * parse_hex_sentence() - Convert a ascii hex representation into byte array. 3362306a36Sopenharmony_ci * @in: Input buffer of ascii. 3462306a36Sopenharmony_ci * @isize: Length of input buffer. 3562306a36Sopenharmony_ci * @out: Output buffer. 3662306a36Sopenharmony_ci * @osize: Length of output buffer, e.g. max number of bytes to parse. 3762306a36Sopenharmony_ci * 3862306a36Sopenharmony_ci * An valid input is a series of ascii hexadecimal numbers, separated by spaces. 3962306a36Sopenharmony_ci * An example valid input is 4062306a36Sopenharmony_ci * " 00 f2 0 000076 6 0 ff" 4162306a36Sopenharmony_ci * 4262306a36Sopenharmony_ci * If an individual "word" within the hex sentence is longer than MAX_WORD_SIZE, 4362306a36Sopenharmony_ci * then the sentence is illegal, and parsing will fail. 4462306a36Sopenharmony_ci * 4562306a36Sopenharmony_ci * Return: Number of bytes parsed, or negative error code on failure. 4662306a36Sopenharmony_ci */ 4762306a36Sopenharmony_cistatic int parse_hex_sentence(const char *in, int isize, u8 *out, int osize) 4862306a36Sopenharmony_ci{ 4962306a36Sopenharmony_ci int n_parsed = 0; 5062306a36Sopenharmony_ci int word_start = 0; 5162306a36Sopenharmony_ci int word_end; 5262306a36Sopenharmony_ci int word_len; 5362306a36Sopenharmony_ci /* Temp buffer for holding a "word" of chars that represents one byte */ 5462306a36Sopenharmony_ci #define MAX_WORD_SIZE 16 5562306a36Sopenharmony_ci char tmp[MAX_WORD_SIZE + 1]; 5662306a36Sopenharmony_ci u8 byte; 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_ci while (word_start < isize && n_parsed < osize) { 5962306a36Sopenharmony_ci /* Find the start of the next word */ 6062306a36Sopenharmony_ci while (word_start < isize && isspace(in[word_start])) 6162306a36Sopenharmony_ci word_start++; 6262306a36Sopenharmony_ci /* reached the end of the input before next word? */ 6362306a36Sopenharmony_ci if (word_start >= isize) 6462306a36Sopenharmony_ci break; 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_ci /* Find the end of this word */ 6762306a36Sopenharmony_ci word_end = word_start; 6862306a36Sopenharmony_ci while (word_end < isize && !isspace(in[word_end])) 6962306a36Sopenharmony_ci word_end++; 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_ci /* Copy to a tmp NULL terminated string */ 7262306a36Sopenharmony_ci word_len = word_end - word_start; 7362306a36Sopenharmony_ci if (word_len > MAX_WORD_SIZE) 7462306a36Sopenharmony_ci return -EINVAL; 7562306a36Sopenharmony_ci memcpy(tmp, in + word_start, word_len); 7662306a36Sopenharmony_ci tmp[word_len] = '\0'; 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_ci /* 7962306a36Sopenharmony_ci * Convert from hex string, place in output. If fails to parse, 8062306a36Sopenharmony_ci * just return -EINVAL because specific error code is only 8162306a36Sopenharmony_ci * relevant for this one word, returning it would be confusing. 8262306a36Sopenharmony_ci */ 8362306a36Sopenharmony_ci if (kstrtou8(tmp, 16, &byte)) 8462306a36Sopenharmony_ci return -EINVAL; 8562306a36Sopenharmony_ci out[n_parsed++] = byte; 8662306a36Sopenharmony_ci 8762306a36Sopenharmony_ci word_start = word_end; 8862306a36Sopenharmony_ci } 8962306a36Sopenharmony_ci return n_parsed; 9062306a36Sopenharmony_ci} 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci/* The message type takes up two bytes*/ 9362306a36Sopenharmony_ci#define TYPE_AND_DATA_SIZE ((EC_MAILBOX_DATA_SIZE) + 2) 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_cistatic ssize_t raw_write(struct file *file, const char __user *user_buf, 9662306a36Sopenharmony_ci size_t count, loff_t *ppos) 9762306a36Sopenharmony_ci{ 9862306a36Sopenharmony_ci char *buf = debug_info->formatted_data; 9962306a36Sopenharmony_ci struct wilco_ec_message msg; 10062306a36Sopenharmony_ci u8 request_data[TYPE_AND_DATA_SIZE]; 10162306a36Sopenharmony_ci ssize_t kcount; 10262306a36Sopenharmony_ci int ret; 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci if (count > FORMATTED_BUFFER_SIZE) 10562306a36Sopenharmony_ci return -EINVAL; 10662306a36Sopenharmony_ci 10762306a36Sopenharmony_ci kcount = simple_write_to_buffer(buf, FORMATTED_BUFFER_SIZE, ppos, 10862306a36Sopenharmony_ci user_buf, count); 10962306a36Sopenharmony_ci if (kcount < 0) 11062306a36Sopenharmony_ci return kcount; 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_ci ret = parse_hex_sentence(buf, kcount, request_data, TYPE_AND_DATA_SIZE); 11362306a36Sopenharmony_ci if (ret < 0) 11462306a36Sopenharmony_ci return ret; 11562306a36Sopenharmony_ci /* Need at least two bytes for message type and one byte of data */ 11662306a36Sopenharmony_ci if (ret < 3) 11762306a36Sopenharmony_ci return -EINVAL; 11862306a36Sopenharmony_ci 11962306a36Sopenharmony_ci msg.type = request_data[0] << 8 | request_data[1]; 12062306a36Sopenharmony_ci msg.flags = 0; 12162306a36Sopenharmony_ci msg.request_data = request_data + 2; 12262306a36Sopenharmony_ci msg.request_size = ret - 2; 12362306a36Sopenharmony_ci memset(debug_info->raw_data, 0, sizeof(debug_info->raw_data)); 12462306a36Sopenharmony_ci msg.response_data = debug_info->raw_data; 12562306a36Sopenharmony_ci msg.response_size = EC_MAILBOX_DATA_SIZE; 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_ci ret = wilco_ec_mailbox(debug_info->ec, &msg); 12862306a36Sopenharmony_ci if (ret < 0) 12962306a36Sopenharmony_ci return ret; 13062306a36Sopenharmony_ci debug_info->response_size = ret; 13162306a36Sopenharmony_ci 13262306a36Sopenharmony_ci return count; 13362306a36Sopenharmony_ci} 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_cistatic ssize_t raw_read(struct file *file, char __user *user_buf, size_t count, 13662306a36Sopenharmony_ci loff_t *ppos) 13762306a36Sopenharmony_ci{ 13862306a36Sopenharmony_ci int fmt_len = 0; 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_ci if (debug_info->response_size) { 14162306a36Sopenharmony_ci fmt_len = hex_dump_to_buffer(debug_info->raw_data, 14262306a36Sopenharmony_ci debug_info->response_size, 14362306a36Sopenharmony_ci 16, 1, debug_info->formatted_data, 14462306a36Sopenharmony_ci sizeof(debug_info->formatted_data), 14562306a36Sopenharmony_ci true); 14662306a36Sopenharmony_ci /* Only return response the first time it is read */ 14762306a36Sopenharmony_ci debug_info->response_size = 0; 14862306a36Sopenharmony_ci } 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_ci return simple_read_from_buffer(user_buf, count, ppos, 15162306a36Sopenharmony_ci debug_info->formatted_data, fmt_len); 15262306a36Sopenharmony_ci} 15362306a36Sopenharmony_ci 15462306a36Sopenharmony_cistatic const struct file_operations fops_raw = { 15562306a36Sopenharmony_ci .owner = THIS_MODULE, 15662306a36Sopenharmony_ci .read = raw_read, 15762306a36Sopenharmony_ci .write = raw_write, 15862306a36Sopenharmony_ci .llseek = no_llseek, 15962306a36Sopenharmony_ci}; 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_ci#define CMD_KB_CHROME 0x88 16262306a36Sopenharmony_ci#define SUB_CMD_H1_GPIO 0x0A 16362306a36Sopenharmony_ci#define SUB_CMD_TEST_EVENT 0x0B 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_cistruct ec_request { 16662306a36Sopenharmony_ci u8 cmd; /* Always CMD_KB_CHROME */ 16762306a36Sopenharmony_ci u8 reserved; 16862306a36Sopenharmony_ci u8 sub_cmd; 16962306a36Sopenharmony_ci} __packed; 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_cistruct ec_response { 17262306a36Sopenharmony_ci u8 status; /* 0 if allowed */ 17362306a36Sopenharmony_ci u8 val; 17462306a36Sopenharmony_ci} __packed; 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_cistatic int send_ec_cmd(struct wilco_ec_device *ec, u8 sub_cmd, u8 *out_val) 17762306a36Sopenharmony_ci{ 17862306a36Sopenharmony_ci struct ec_request rq; 17962306a36Sopenharmony_ci struct ec_response rs; 18062306a36Sopenharmony_ci struct wilco_ec_message msg; 18162306a36Sopenharmony_ci int ret; 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_ci memset(&rq, 0, sizeof(rq)); 18462306a36Sopenharmony_ci rq.cmd = CMD_KB_CHROME; 18562306a36Sopenharmony_ci rq.sub_cmd = sub_cmd; 18662306a36Sopenharmony_ci 18762306a36Sopenharmony_ci memset(&msg, 0, sizeof(msg)); 18862306a36Sopenharmony_ci msg.type = WILCO_EC_MSG_LEGACY; 18962306a36Sopenharmony_ci msg.request_data = &rq; 19062306a36Sopenharmony_ci msg.request_size = sizeof(rq); 19162306a36Sopenharmony_ci msg.response_data = &rs; 19262306a36Sopenharmony_ci msg.response_size = sizeof(rs); 19362306a36Sopenharmony_ci ret = wilco_ec_mailbox(ec, &msg); 19462306a36Sopenharmony_ci if (ret < 0) 19562306a36Sopenharmony_ci return ret; 19662306a36Sopenharmony_ci if (rs.status) 19762306a36Sopenharmony_ci return -EIO; 19862306a36Sopenharmony_ci 19962306a36Sopenharmony_ci *out_val = rs.val; 20062306a36Sopenharmony_ci 20162306a36Sopenharmony_ci return 0; 20262306a36Sopenharmony_ci} 20362306a36Sopenharmony_ci 20462306a36Sopenharmony_ci/** 20562306a36Sopenharmony_ci * h1_gpio_get() - Gets h1 gpio status. 20662306a36Sopenharmony_ci * @arg: The wilco EC device. 20762306a36Sopenharmony_ci * @val: BIT(0)=ENTRY_TO_FACT_MODE, BIT(1)=SPI_CHROME_SEL 20862306a36Sopenharmony_ci */ 20962306a36Sopenharmony_cistatic int h1_gpio_get(void *arg, u64 *val) 21062306a36Sopenharmony_ci{ 21162306a36Sopenharmony_ci int ret; 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci ret = send_ec_cmd(arg, SUB_CMD_H1_GPIO, (u8 *)val); 21462306a36Sopenharmony_ci if (ret == 0) 21562306a36Sopenharmony_ci *val &= 0xFF; 21662306a36Sopenharmony_ci return ret; 21762306a36Sopenharmony_ci} 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_ciDEFINE_DEBUGFS_ATTRIBUTE(fops_h1_gpio, h1_gpio_get, NULL, "0x%02llx\n"); 22062306a36Sopenharmony_ci 22162306a36Sopenharmony_ci/** 22262306a36Sopenharmony_ci * test_event_set() - Sends command to EC to cause an EC test event. 22362306a36Sopenharmony_ci * @arg: The wilco EC device. 22462306a36Sopenharmony_ci * @val: unused. 22562306a36Sopenharmony_ci */ 22662306a36Sopenharmony_cistatic int test_event_set(void *arg, u64 val) 22762306a36Sopenharmony_ci{ 22862306a36Sopenharmony_ci u8 ret; 22962306a36Sopenharmony_ci 23062306a36Sopenharmony_ci return send_ec_cmd(arg, SUB_CMD_TEST_EVENT, &ret); 23162306a36Sopenharmony_ci} 23262306a36Sopenharmony_ci 23362306a36Sopenharmony_ci/* Format is unused since it is only required for get method which is NULL */ 23462306a36Sopenharmony_ciDEFINE_DEBUGFS_ATTRIBUTE(fops_test_event, NULL, test_event_set, "%llu\n"); 23562306a36Sopenharmony_ci 23662306a36Sopenharmony_ci/** 23762306a36Sopenharmony_ci * wilco_ec_debugfs_probe() - Create the debugfs node 23862306a36Sopenharmony_ci * @pdev: The platform device, probably created in core.c 23962306a36Sopenharmony_ci * 24062306a36Sopenharmony_ci * Try to create a debugfs node. If it fails, then we don't want to change 24162306a36Sopenharmony_ci * behavior at all, this is for debugging after all. Just fail silently. 24262306a36Sopenharmony_ci * 24362306a36Sopenharmony_ci * Return: 0 always. 24462306a36Sopenharmony_ci */ 24562306a36Sopenharmony_cistatic int wilco_ec_debugfs_probe(struct platform_device *pdev) 24662306a36Sopenharmony_ci{ 24762306a36Sopenharmony_ci struct wilco_ec_device *ec = dev_get_drvdata(pdev->dev.parent); 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci debug_info = devm_kzalloc(&pdev->dev, sizeof(*debug_info), GFP_KERNEL); 25062306a36Sopenharmony_ci if (!debug_info) 25162306a36Sopenharmony_ci return 0; 25262306a36Sopenharmony_ci debug_info->ec = ec; 25362306a36Sopenharmony_ci debug_info->dir = debugfs_create_dir("wilco_ec", NULL); 25462306a36Sopenharmony_ci debugfs_create_file("raw", 0644, debug_info->dir, NULL, &fops_raw); 25562306a36Sopenharmony_ci debugfs_create_file("h1_gpio", 0444, debug_info->dir, ec, 25662306a36Sopenharmony_ci &fops_h1_gpio); 25762306a36Sopenharmony_ci debugfs_create_file("test_event", 0200, debug_info->dir, ec, 25862306a36Sopenharmony_ci &fops_test_event); 25962306a36Sopenharmony_ci 26062306a36Sopenharmony_ci return 0; 26162306a36Sopenharmony_ci} 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_cistatic int wilco_ec_debugfs_remove(struct platform_device *pdev) 26462306a36Sopenharmony_ci{ 26562306a36Sopenharmony_ci debugfs_remove_recursive(debug_info->dir); 26662306a36Sopenharmony_ci 26762306a36Sopenharmony_ci return 0; 26862306a36Sopenharmony_ci} 26962306a36Sopenharmony_ci 27062306a36Sopenharmony_cistatic struct platform_driver wilco_ec_debugfs_driver = { 27162306a36Sopenharmony_ci .driver = { 27262306a36Sopenharmony_ci .name = DRV_NAME, 27362306a36Sopenharmony_ci }, 27462306a36Sopenharmony_ci .probe = wilco_ec_debugfs_probe, 27562306a36Sopenharmony_ci .remove = wilco_ec_debugfs_remove, 27662306a36Sopenharmony_ci}; 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_cimodule_platform_driver(wilco_ec_debugfs_driver); 27962306a36Sopenharmony_ci 28062306a36Sopenharmony_ciMODULE_ALIAS("platform:" DRV_NAME); 28162306a36Sopenharmony_ciMODULE_AUTHOR("Nick Crews <ncrews@chromium.org>"); 28262306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 28362306a36Sopenharmony_ciMODULE_DESCRIPTION("Wilco EC debugfs driver"); 284