nvec.c revision 97f4be60178fec663baaa30a09ae102fd33373c2
1162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich/* 2162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * NVEC: NVIDIA compliant embedded controller interface 3162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * 4162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.lauchpad.net> 5162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * 6162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * Authors: Pierre-Hugues Husson <phhusson@free.fr> 7162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * Ilya Petrov <ilya.muromec@gmail.com> 8162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * Marc Dietrich <marvin24@gmx.de> 9791c4a642721552204d8defdbd6a3e93cd411f79Julian Andres Klode * Julian Andres Klode <jak@jak-linux.org> 10162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * 11162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * This file is subject to the terms and conditions of the GNU General Public 12162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * License. See the file "COPYING" in the main directory of this archive 13162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * for more details. 14162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich * 15162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich */ 16162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 17162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich/* #define DEBUG */ 1832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 1912b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/kernel.h> 203b769edd58371fb70417c3f43c6d4a2da075703aMarc Dietrich#include <linux/module.h> 210b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode#include <linux/atomic.h> 2212b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/clk.h> 2332890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/completion.h> 2412b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/delay.h> 2512b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/err.h> 2612b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/gpio.h> 2732890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/interrupt.h> 28162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich#include <linux/io.h> 2932890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/irq.h> 307990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich#include <linux/of.h> 317990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich#include <linux/of_gpio.h> 3232890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/list.h> 3312b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/mfd/core.h> 3412b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/mutex.h> 3532890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/notifier.h> 3632890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/platform_device.h> 3712b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/slab.h> 3812b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/spinlock.h> 3912b5a55d725579d0978da67f26577224a1c40640Julian Andres Klode#include <linux/workqueue.h> 40162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 41162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich#include <mach/clk.h> 42162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 4332890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include "nvec.h" 4432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 45391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_CNFG 0x00 46391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_CNFG_PACKET_MODE_EN (1<<10) 47391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_CNFG_NEW_MASTER_SFM (1<<11) 48391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_CNFG_DEBOUNCE_CNT_SHIFT 12 49391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode 50391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_CNFG 0x20 51d3f862aec400dd831a4bdbea107fd85419bddab1Julian Andres Klode#define I2C_SL_NEWSL (1<<2) 52391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_NACK (1<<1) 53391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_RESP (1<<0) 54391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_IRQ (1<<3) 55391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define END_TRANS (1<<4) 56391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define RCVD (1<<2) 57391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define RNW (1<<1) 58391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode 59391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_RCVD 0x24 60391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_STATUS 0x28 61391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_ADDR1 0x2c 62391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_ADDR2 0x30 63391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode#define I2C_SL_DELAY_COUNT 0x3c 64391d2fa95c8e5e5ad3b06af235ce4aeae6514966Julian Andres Klode 65bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode/** 66bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * enum nvec_msg_category - Message categories for nvec_msg_alloc() 67bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * @NVEC_MSG_RX: The message is an incoming message (from EC) 68bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * @NVEC_MSG_TX: The message is an outgoing message (to EC) 69bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode */ 70bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klodeenum nvec_msg_category { 71bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode NVEC_MSG_RX, 72bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode NVEC_MSG_TX, 73bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode}; 74bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode 75162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic const unsigned char EC_DISABLE_EVENT_REPORTING[3] = "\x04\x00\x00"; 76162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic const unsigned char EC_ENABLE_EVENT_REPORTING[3] = "\x04\x00\x01"; 77162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic const unsigned char EC_GET_FIRMWARE_VERSION[2] = "\x07\x15"; 7832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 7932890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic struct nvec_chip *nvec_power_handle; 8032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 81f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrichstatic struct mfd_cell nvec_devices[] = { 82f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich { 83162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .name = "nvec-kbd", 84162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .id = 1, 85f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich }, 86f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich { 87162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .name = "nvec-mouse", 88162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .id = 1, 89f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich }, 90f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich { 91162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .name = "nvec-power", 92162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .id = 1, 93f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich }, 94f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich { 95162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .name = "nvec-power", 96162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .id = 2, 97f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich }, 9897cc26576fa2b0eb1aad1b29515bb0a32f86c45cIlya Petrov { 99ac562680577a28fa98ebecebff5e5097ccf9a9d2Marc Dietrich .name = "nvec-paz00", 10097cc26576fa2b0eb1aad1b29515bb0a32f86c45cIlya Petrov .id = 1, 10197cc26576fa2b0eb1aad1b29515bb0a32f86c45cIlya Petrov }, 102f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich}; 103f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 104bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 105bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_register_notifier - Register a notifier with nvec 106bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 107bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nb: The notifier block to register 108bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 109bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Registers a notifier with @nvec. The notifier will be added to an atomic 110bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * notifier chain that is called for all received messages except those that 111bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * correspond to a request initiated by nvec_write_sync(). 112bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 11332890b983086136fef8721363a2d3860f337ad53Marc Dietrichint nvec_register_notifier(struct nvec_chip *nvec, struct notifier_block *nb, 114162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich unsigned int events) 11532890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 11632890b983086136fef8721363a2d3860f337ad53Marc Dietrich return atomic_notifier_chain_register(&nvec->notifier_list, nb); 11732890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 11832890b983086136fef8721363a2d3860f337ad53Marc DietrichEXPORT_SYMBOL_GPL(nvec_register_notifier); 11932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 120bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 121bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_status_notifier - The final notifier 122bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 123bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Prints a message about control events not handled in the notifier 124bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * chain. 125bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 126162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic int nvec_status_notifier(struct notifier_block *nb, 127162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich unsigned long event_type, void *data) 12832890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 12950d4656a2304e48917a8e2b9df99f69d50b8a0aaMarc Dietrich struct nvec_chip *nvec = container_of(nb, struct nvec_chip, 13050d4656a2304e48917a8e2b9df99f69d50b8a0aaMarc Dietrich nvec_status_notifier); 13132890b983086136fef8721363a2d3860f337ad53Marc Dietrich unsigned char *msg = (unsigned char *)data; 13232890b983086136fef8721363a2d3860f337ad53Marc Dietrich 133162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (event_type != NVEC_CNTL) 13432890b983086136fef8721363a2d3860f337ad53Marc Dietrich return NOTIFY_DONE; 13532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 13650d4656a2304e48917a8e2b9df99f69d50b8a0aaMarc Dietrich dev_warn(nvec->dev, "unhandled msg type %ld\n", event_type); 137a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich print_hex_dump(KERN_WARNING, "payload: ", DUMP_PREFIX_NONE, 16, 1, 138a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich msg, msg[1] + 2, true); 13932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 14032890b983086136fef8721363a2d3860f337ad53Marc Dietrich return NOTIFY_OK; 14132890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 14232890b983086136fef8721363a2d3860f337ad53Marc Dietrich 143bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 144bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_msg_alloc: 145bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 146bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * @category: Pool category, see &enum nvec_msg_category 147bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 148bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Allocate a single &struct nvec_msg object from the message pool of 149bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec. The result shall be passed to nvec_msg_free() if no longer 150bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * used. 151bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * 152bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * Outgoing messages are placed in the upper 75% of the pool, keeping the 153bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * lower 25% available for RX buffers only. The reason is to prevent a 154bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * situation where all buffers are full and a message is thus endlessly 155bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode * retried because the response could never be processed. 156bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 157bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klodestatic struct nvec_msg *nvec_msg_alloc(struct nvec_chip *nvec, 158bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode enum nvec_msg_category category) 1590b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode{ 160bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode int i = (category == NVEC_MSG_TX) ? (NVEC_POOL_SIZE / 4) : 0; 1610b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 162bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode for (; i < NVEC_POOL_SIZE; i++) { 1630b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode if (atomic_xchg(&nvec->msg_pool[i].used, 1) == 0) { 1640b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode dev_vdbg(nvec->dev, "INFO: Allocate %i\n", i); 1650b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode return &nvec->msg_pool[i]; 1660b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode } 1670b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode } 1680b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 169bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode dev_err(nvec->dev, "could not allocate %s buffer\n", 170bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode (category == NVEC_MSG_TX) ? "TX" : "RX"); 1710b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 1720b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode return NULL; 1730b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode} 1740b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 175bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 176bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_msg_free: 177bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 178bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @msg: A message (must be allocated by nvec_msg_alloc() and belong to @nvec) 179bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 180bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Free the given message 181bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 182198dd26714ba4a60ccc5ce70bc4506613b4f0c2dJulian Andres Klodeinline void nvec_msg_free(struct nvec_chip *nvec, struct nvec_msg *msg) 1830b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode{ 1847b77065793b8de101c7be3829b4ff8a4618a7172Julian Andres Klode if (msg != &nvec->tx_scratch) 1857b77065793b8de101c7be3829b4ff8a4618a7172Julian Andres Klode dev_vdbg(nvec->dev, "INFO: Free %ti\n", msg - nvec->msg_pool); 1860b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode atomic_set(&msg->used, 0); 1870b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode} 188198dd26714ba4a60ccc5ce70bc4506613b4f0c2dJulian Andres KlodeEXPORT_SYMBOL_GPL(nvec_msg_free); 1890b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 1908517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode/** 1918517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * nvec_msg_is_event - Return %true if @msg is an event 1928517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * @msg: A message 1938517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode */ 1948517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klodestatic bool nvec_msg_is_event(struct nvec_msg *msg) 1958517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode{ 1968517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return msg->data[0] >> 7; 1978517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode} 1988517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode 1998517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode/** 2008517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * nvec_msg_size - Get the size of a message 2018517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * @msg: The message to get the size for 2028517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * 2038517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * This only works for received messages, not for outgoing messages. 2048517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode */ 2058517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klodestatic size_t nvec_msg_size(struct nvec_msg *msg) 2068517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode{ 2078517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode bool is_event = nvec_msg_is_event(msg); 2088517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode int event_length = (msg->data[0] & 0x60) >> 5; 2098517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode 2108517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode /* for variable size, payload size in byte 1 + count (1) + cmd (1) */ 2118517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode if (!is_event || event_length == NVEC_VAR_SIZE) 2128517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return (msg->pos || msg->size) ? (msg->data[1] + 2) : 0; 2138517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode else if (event_length == NVEC_2BYTES) 2148517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return 2; 2158517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode else if (event_length == NVEC_3BYTES) 2168517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return 3; 2178517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode else 2188517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return 0; 2198517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode} 2208517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode 221bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 222bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_gpio_set_value - Set the GPIO value 223bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 224bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @value: The value to write (0 or 1) 225bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 226bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Like gpio_set_value(), but generating debugging information 227bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 228e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klodestatic void nvec_gpio_set_value(struct nvec_chip *nvec, int value) 229e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode{ 230e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode dev_dbg(nvec->dev, "GPIO changed from %u to %u\n", 231e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode gpio_get_value(nvec->gpio), value); 232e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode gpio_set_value(nvec->gpio, value); 233e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode} 234e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode 235bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 236bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_write_async - Asynchronously write a message to NVEC 237bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: An nvec_chip instance 238bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @data: The message data, starting with the request type 239bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @size: The size of @data 240bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 241bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Queue a single message to be transferred to the embedded controller 242bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * and return immediately. 243bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 244bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Returns: 0 on success, a negative error code on failure. If a failure 245bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * occured, the nvec driver may print an error. 246bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 2471b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klodeint nvec_write_async(struct nvec_chip *nvec, const unsigned char *data, 248162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich short size) 24932890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 2500cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode struct nvec_msg *msg; 2510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned long flags; 25232890b983086136fef8721363a2d3860f337ad53Marc Dietrich 253bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode msg = nvec_msg_alloc(nvec, NVEC_MSG_TX); 254bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode 2551b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode if (msg == NULL) 2561b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode return -ENOMEM; 2571b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode 25832890b983086136fef8721363a2d3860f337ad53Marc Dietrich msg->data[0] = size; 25932890b983086136fef8721363a2d3860f337ad53Marc Dietrich memcpy(msg->data + 1, data, size); 26032890b983086136fef8721363a2d3860f337ad53Marc Dietrich msg->size = size + 1; 26132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 2620cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 26332890b983086136fef8721363a2d3860f337ad53Marc Dietrich list_add_tail(&msg->node, &nvec->tx_data); 2640cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 26532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 266033d9959ed2dc1029217d4165f80a71702dc578eLinus Torvalds schedule_work(&nvec->tx_work); 2671b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode 2681b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode return 0; 26932890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 27032890b983086136fef8721363a2d3860f337ad53Marc DietrichEXPORT_SYMBOL(nvec_write_async); 27132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 272bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 273bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_write_sync - Write a message to nvec and read the response 274bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: An &struct nvec_chip 275bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @data: The data to write 276bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @size: The size of @data 277bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 278bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * This is similar to nvec_write_async(), but waits for the 279bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * request to be answered before returning. This function 280bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * uses a mutex and can thus not be called from e.g. 281bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * interrupt handlers. 282bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 283bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Returns: A pointer to the response message on success, 284198dd26714ba4a60ccc5ce70bc4506613b4f0c2dJulian Andres Klode * %NULL on failure. Free with nvec_msg_free() once no longer 285198dd26714ba4a60ccc5ce70bc4506613b4f0c2dJulian Andres Klode * used. 286bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 2870cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestruct nvec_msg *nvec_write_sync(struct nvec_chip *nvec, 2880cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode const unsigned char *data, short size) 2890cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 2900cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode struct nvec_msg *msg; 2910cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2920cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode mutex_lock(&nvec->sync_write_mutex); 2930cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2940cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->sync_write_pending = (data[1] << 8) + data[0]; 2951b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode 2964b8bf03d7f775271c2016e76011b113bc5f83c14Marc Dietrich if (nvec_write_async(nvec, data, size) < 0) { 2974b8bf03d7f775271c2016e76011b113bc5f83c14Marc Dietrich mutex_unlock(&nvec->sync_write_mutex); 2981b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode return NULL; 2994b8bf03d7f775271c2016e76011b113bc5f83c14Marc Dietrich } 3000cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3010cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_dbg(nvec->dev, "nvec_sync_write: 0x%04x\n", 3020cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->sync_write_pending); 3030cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (!(wait_for_completion_timeout(&nvec->sync_write, 3040cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msecs_to_jiffies(2000)))) { 3050cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_warn(nvec->dev, "timeout waiting for sync write to complete\n"); 3060cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode mutex_unlock(&nvec->sync_write_mutex); 3070cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode return NULL; 3080cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 3090cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3100cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_dbg(nvec->dev, "nvec_sync_write: pong!\n"); 3110cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3120cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg = nvec->last_sync_msg; 3130cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3140cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode mutex_unlock(&nvec->sync_write_mutex); 3150cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3160cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode return msg; 3170cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 3180cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres KlodeEXPORT_SYMBOL(nvec_write_sync); 3190cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 320bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 321bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_request_master - Process outgoing messages 322bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @work: A &struct work_struct (the tx_worker member of &struct nvec_chip) 323bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 324bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Processes all outgoing requests by sending the request and awaiting the 325bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * response, then continuing with the next request. Once a request has a 326bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * matching response, it will be freed and removed from the list. 327bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 32832890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic void nvec_request_master(struct work_struct *work) 32932890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 33032890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec = container_of(work, struct nvec_chip, tx_work); 3310cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned long flags; 3320cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode long err; 3330cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode struct nvec_msg *msg; 3340cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3350cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 3360cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode while (!list_empty(&nvec->tx_data)) { 3370cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg = list_first_entry(&nvec->tx_data, struct nvec_msg, node); 3380cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 3390cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_gpio_set_value(nvec, 0); 3400cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode err = wait_for_completion_interruptible_timeout( 3410cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode &nvec->ec_transfer, msecs_to_jiffies(5000)); 3420cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3430cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (err == 0) { 3440cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_warn(nvec->dev, "timeout waiting for ec transfer\n"); 3450cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_gpio_set_value(nvec, 1); 3460cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg->pos = 0; 3470cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 34832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 3490cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 3500cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (err > 0) { 3520cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode list_del_init(&msg->node); 3530cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_msg_free(nvec, msg); 3540cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 3550cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 3560cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 35732890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 35832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 359bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 360bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * parse_msg - Print some information and call the notifiers on an RX message 361bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 362bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @msg: A message received by @nvec 363bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 364bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Paarse some pieces of the message and then call the chain of notifiers 365bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * registered via nvec_register_notifier. 366bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 36732890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic int parse_msg(struct nvec_chip *nvec, struct nvec_msg *msg) 36832890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 369162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if ((msg->data[0] & 1 << 7) == 0 && msg->data[3]) { 3706a371978836049656525bb0719187362c5114232Andy Shevchenko dev_err(nvec->dev, "ec responded %*ph\n", 4, msg->data); 37132890b983086136fef8721363a2d3860f337ad53Marc Dietrich return -EINVAL; 37232890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 37332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 374a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich if ((msg->data[0] >> 7) == 1 && (msg->data[0] & 0x0f) == 5) 375a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich print_hex_dump(KERN_WARNING, "ec system event ", 376a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich DUMP_PREFIX_NONE, 16, 1, msg->data, 377a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich msg->data[1] + 2, true); 37832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 379162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich atomic_notifier_call_chain(&nvec->notifier_list, msg->data[0] & 0x8f, 380162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich msg->data); 38132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 38232890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 38332890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 38432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 385bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 386bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_dispatch - Process messages received from the EC 387bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @work: A &struct work_struct (the tx_worker member of &struct nvec_chip) 388bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 389bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Process messages previously received from the EC and put into the RX 390bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * queue of the &struct nvec_chip instance associated with @work. 391bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 39232890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic void nvec_dispatch(struct work_struct *work) 39332890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 39432890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec = container_of(work, struct nvec_chip, rx_work); 3950cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned long flags; 39632890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_msg *msg; 39732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 3980cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->rx_lock, flags); 399162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich while (!list_empty(&nvec->rx_data)) { 40032890b983086136fef8721363a2d3860f337ad53Marc Dietrich msg = list_first_entry(&nvec->rx_data, struct nvec_msg, node); 40132890b983086136fef8721363a2d3860f337ad53Marc Dietrich list_del_init(&msg->node); 4020cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->rx_lock, flags); 40332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 404162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (nvec->sync_write_pending == 4050cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (msg->data[2] << 8) + msg->data[0]) { 40632890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_dbg(nvec->dev, "sync write completed!\n"); 40732890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->sync_write_pending = 0; 40832890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->last_sync_msg = msg; 40932890b983086136fef8721363a2d3860f337ad53Marc Dietrich complete(&nvec->sync_write); 41032890b983086136fef8721363a2d3860f337ad53Marc Dietrich } else { 41132890b983086136fef8721363a2d3860f337ad53Marc Dietrich parse_msg(nvec, msg); 4120cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_msg_free(nvec, msg); 41332890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 4140cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->rx_lock, flags); 41532890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 4160cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->rx_lock, flags); 41732890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 41832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 419bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 420bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_tx_completed - Complete the current transfer 421bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 422bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 423bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * This is called when we have received an END_TRANS on a TX transfer. 424bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 4250cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestatic void nvec_tx_completed(struct nvec_chip *nvec) 4260cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 4270cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* We got an END_TRANS, let's skip this, maybe there's an event */ 4280cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (nvec->tx->pos != nvec->tx->size) { 4290cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "premature END_TRANS, resending\n"); 4300cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx->pos = 0; 4310cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_gpio_set_value(nvec, 0); 4320cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else { 4330cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 4340cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 4350cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 4360cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 437bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 438bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_rx_completed - Complete the current transfer 439bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 440bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 441bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * This is called when we have received an END_TRANS on a RX transfer. 442bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 4430cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestatic void nvec_rx_completed(struct nvec_chip *nvec) 4440cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 445210ceb4f68dcc7bede2e3af547abd6f661a7bfdaJulian Andres Klode if (nvec->rx->pos != nvec_msg_size(nvec->rx)) { 4460cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "RX incomplete: Expected %u bytes, got %u\n", 4470cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint) nvec_msg_size(nvec->rx), 4480cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint) nvec->rx->pos); 4490cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 450210ceb4f68dcc7bede2e3af547abd6f661a7bfdaJulian Andres Klode nvec_msg_free(nvec, nvec->rx); 451210ceb4f68dcc7bede2e3af547abd6f661a7bfdaJulian Andres Klode nvec->state = 0; 452d6bdcf2e1019351cbc176e963b7756766bdd8721Julian Andres Klode 453d6bdcf2e1019351cbc176e963b7756766bdd8721Julian Andres Klode /* Battery quirk - Often incomplete, and likes to crash */ 454d6bdcf2e1019351cbc176e963b7756766bdd8721Julian Andres Klode if (nvec->rx->data[0] == NVEC_BAT) 455d6bdcf2e1019351cbc176e963b7756766bdd8721Julian Andres Klode complete(&nvec->ec_transfer); 456d6bdcf2e1019351cbc176e963b7756766bdd8721Julian Andres Klode 457210ceb4f68dcc7bede2e3af547abd6f661a7bfdaJulian Andres Klode return; 458210ceb4f68dcc7bede2e3af547abd6f661a7bfdaJulian Andres Klode } 459210ceb4f68dcc7bede2e3af547abd6f661a7bfdaJulian Andres Klode 4600cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock(&nvec->rx_lock); 4610cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4620cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* add the received data to the work list 4630cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode and move the ring buffer pointer to the next entry */ 4640cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode list_add_tail(&nvec->rx->node, &nvec->rx_data); 4650cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4660cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock(&nvec->rx_lock); 4670cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4680cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 4690cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4700cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (!nvec_msg_is_event(nvec->rx)) 4710cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode complete(&nvec->ec_transfer); 4720cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 473033d9959ed2dc1029217d4165f80a71702dc578eLinus Torvalds schedule_work(&nvec->rx_work); 4740cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 4750cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4760cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode/** 4770cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * nvec_invalid_flags - Send an error message about invalid flags and jump 4780cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @nvec: The nvec device 4790cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @status: The status flags 4800cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @reset: Whether we shall jump to state 0. 4810cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode */ 4820cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestatic void nvec_invalid_flags(struct nvec_chip *nvec, unsigned int status, 4830cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode bool reset) 4840cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 4850cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "unexpected status flags 0x%02x during state %i\n", 4860cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status, nvec->state); 4870cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (reset) 4880cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 4890cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 4900cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4910cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode/** 4920cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * nvec_tx_set - Set the message to transfer (nvec->tx) 493bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 494bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 495bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Gets the first entry from the tx_data list of @nvec and sets the 496bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * tx member to it. If the tx_data list is empty, this uses the 497bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * tx_scratch message to send a no operation message. 4980cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode */ 4990cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestatic void nvec_tx_set(struct nvec_chip *nvec) 5000cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 5010cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock(&nvec->tx_lock); 5020cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (list_empty(&nvec->tx_data)) { 5030cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "empty tx - sending no-op\n"); 5040cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode memcpy(nvec->tx_scratch.data, "\x02\x07\x02", 3); 5050cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx_scratch.size = 3; 5060cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx_scratch.pos = 0; 5070cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx = &nvec->tx_scratch; 5080cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode list_add_tail(&nvec->tx->node, &nvec->tx_data); 5090cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else { 5100cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx = list_first_entry(&nvec->tx_data, struct nvec_msg, 5110cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode node); 5120cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx->pos = 0; 5130cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 5140cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock(&nvec->tx_lock); 5150cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 5160cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_dbg(nvec->dev, "Sending message of length %u, command 0x%x\n", 5170cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint)nvec->tx->size, nvec->tx->data[1]); 5180cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 5190cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 5200cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode/** 5210cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * nvec_interrupt - Interrupt handler 5220cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @irq: The IRQ 5230cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @dev: The nvec device 524bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 525bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Interrupt handler that fills our RX buffers and empties our TX 526bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * buffers. This uses a finite state machine with ridiculous amounts 527bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * of error checking, in order to be fairly reliable. 5280cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode */ 529f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrichstatic irqreturn_t nvec_interrupt(int irq, void *dev) 53032890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 53132890b983086136fef8721363a2d3860f337ad53Marc Dietrich unsigned long status; 5320cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned int received = 0; 5330cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned char to_send = 0xff; 5340cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode const unsigned long irq_mask = I2C_SL_IRQ | END_TRANS | RCVD | RNW; 5350cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode struct nvec_chip *nvec = dev; 5360cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned int state = nvec->state; 53732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 5380cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status = readl(nvec->base + I2C_SL_STATUS); 53932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 5400cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* Filter out some errors */ 5410cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & irq_mask) == 0 && (status & ~irq_mask) != 0) { 5420cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "unexpected irq mask %lx\n", status); 5430cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode return IRQ_HANDLED; 54432890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 5450cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & I2C_SL_IRQ) == 0) { 5460cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "Spurious IRQ\n"); 54732890b983086136fef8721363a2d3860f337ad53Marc Dietrich return IRQ_HANDLED; 5480cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 54932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 5500cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* The EC did not request a read, so it send us something, read it */ 5510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & RNW) == 0) { 5520cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode received = readl(nvec->base + I2C_SL_RCVD); 553162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (status & RCVD) 5540cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode writel(0, nvec->base + I2C_SL_RCVD); 5550cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 556162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 5570cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status == (I2C_SL_IRQ | RCVD)) 5580cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 5590cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 5600cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode switch (nvec->state) { 5610cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 0: /* Verify that its a transfer start, the rest later */ 5620cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status != (I2C_SL_IRQ | RCVD)) 5630cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, false); 5640cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 5650cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 1: /* command byte */ 5660cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status != I2C_SL_IRQ) { 5670cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, true); 56832890b983086136fef8721363a2d3860f337ad53Marc Dietrich } else { 569bb0590e2723eed53b524d61cf011d53fc7280949Julian Andres Klode nvec->rx = nvec_msg_alloc(nvec, NVEC_MSG_RX); 5708da798634343de8dbb8c1593923f8368db69f838Julian Andres Klode /* Should not happen in a normal world */ 5718da798634343de8dbb8c1593923f8368db69f838Julian Andres Klode if (unlikely(nvec->rx == NULL)) { 5728da798634343de8dbb8c1593923f8368db69f838Julian Andres Klode nvec->state = 0; 5738da798634343de8dbb8c1593923f8368db69f838Julian Andres Klode break; 5748da798634343de8dbb8c1593923f8368db69f838Julian Andres Klode } 5750cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->data[0] = received; 5760cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->pos = 1; 5770cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 2; 5780cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 5790cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 5800cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 2: /* first byte after command */ 5810cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status == (I2C_SL_IRQ | RNW | RCVD)) { 5820cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode udelay(33); 5830cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (nvec->rx->data[0] != 0x01) { 5840cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, 5850cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "Read without prior read command\n"); 5860cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 5870cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 58832890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 5890cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_msg_free(nvec, nvec->rx); 5900cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 3; 5910cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_tx_set(nvec); 5920cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode BUG_ON(nvec->tx->size < 1); 5930cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode to_send = nvec->tx->data[0]; 5940cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx->pos = 1; 5950cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else if (status == (I2C_SL_IRQ)) { 5960cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode BUG_ON(nvec->rx == NULL); 5970cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->data[1] = received; 5980cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->pos = 2; 5990cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 4; 6000cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else { 6010cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, true); 60232890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 6030cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 6040cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 3: /* EC does a block read, we transmit data */ 6050cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status & END_TRANS) { 6060cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_tx_completed(nvec); 6070cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else if ((status & RNW) == 0 || (status & RCVD)) { 6080cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, true); 6090cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else if (nvec->tx && nvec->tx->pos < nvec->tx->size) { 6100cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode to_send = nvec->tx->data[nvec->tx->pos++]; 6110cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else { 6120cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "tx buffer underflow on %p (%u > %u)\n", 6130cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx, 6140cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint) (nvec->tx ? nvec->tx->pos : 0), 6150cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint) (nvec->tx ? nvec->tx->size : 0)); 6160cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 61732890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 6180cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 6190cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 4: /* EC does some write, we read the data */ 6200cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & (END_TRANS | RNW)) == END_TRANS) 6210cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_rx_completed(nvec); 6220cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode else if (status & (RNW | RCVD)) 6230cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, true); 6240cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode else if (nvec->rx && nvec->rx->pos < NVEC_MSG_SIZE) 6250cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->data[nvec->rx->pos++] = received; 6260cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode else 6270cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, 6280cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "RX buffer overflow on %p: " 6290cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "Trying to write byte %u of %u\n", 6300cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx, nvec->rx->pos, NVEC_MSG_SIZE); 6310cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 6320cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode default: 6330cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 6340cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 63532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 6360cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* If we are told that a new transfer starts, verify it */ 6370cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & (RCVD | RNW)) == RCVD) { 6380cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (received != nvec->i2c_addr) 6390cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, 6400cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "received address 0x%02x, expected 0x%02x\n", 6410cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode received, nvec->i2c_addr); 6420cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 1; 64332890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 6440cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 6450cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* Send data if requested, but not on end of transmission */ 6460cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & (RNW | END_TRANS)) == RNW) 6470cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode writel(to_send, nvec->base + I2C_SL_RCVD); 6480cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 6490cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* If we have send the first byte */ 6500cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status == (I2C_SL_IRQ | RNW | RCVD)) 6510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_gpio_set_value(nvec, 1); 6520cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 6530cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_dbg(nvec->dev, 6540cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "Handled: %s 0x%02x, %s 0x%02x in state %u [%s%s%s]\n", 6550cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (status & RNW) == 0 ? "received" : "R=", 6560cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode received, 6570cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (status & (RNW | END_TRANS)) ? "sent" : "S=", 6580cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode to_send, 6590cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode state, 6600cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status & END_TRANS ? " END_TRANS" : "", 6610cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status & RCVD ? " RCVD" : "", 6620cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status & RNW ? " RNW" : ""); 6630cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 664de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode 665de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode /* 666de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode * TODO: A correct fix needs to be found for this. 667de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode * 668de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode * We experience less incomplete messages with this delay than without 669de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode * it, but we don't know why. Help is appreciated. 670de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode */ 671de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode udelay(100); 672de839b8f06bc5dd3f5037c4409a720cbb9bf21c3Julian Andres Klode 67332890b983086136fef8721363a2d3860f337ad53Marc Dietrich return IRQ_HANDLED; 67432890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 67532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 676f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrichstatic void tegra_init_i2c_slave(struct nvec_chip *nvec) 67732890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 67832890b983086136fef8721363a2d3860f337ad53Marc Dietrich u32 val; 67932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 68061c3b1971ad4c71c99919da949ac2043dfac8ee7Prashant Gaikwad clk_prepare_enable(nvec->i2c_clk); 681f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 682f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich tegra_periph_reset_assert(nvec->i2c_clk); 68332890b983086136fef8721363a2d3860f337ad53Marc Dietrich udelay(2); 684f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich tegra_periph_reset_deassert(nvec->i2c_clk); 68532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 68632890b983086136fef8721363a2d3860f337ad53Marc Dietrich val = I2C_CNFG_NEW_MASTER_SFM | I2C_CNFG_PACKET_MODE_EN | 687ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich (0x2 << I2C_CNFG_DEBOUNCE_CNT_SHIFT); 688f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich writel(val, nvec->base + I2C_CNFG); 689ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 690ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich clk_set_rate(nvec->i2c_clk, 8 * 80000); 691ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 692d3f862aec400dd831a4bdbea107fd85419bddab1Julian Andres Klode writel(I2C_SL_NEWSL, nvec->base + I2C_SL_CNFG); 693ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich writel(0x1E, nvec->base + I2C_SL_DELAY_COUNT); 694ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 695ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich writel(nvec->i2c_addr>>1, nvec->base + I2C_SL_ADDR1); 696ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich writel(0, nvec->base + I2C_SL_ADDR2); 69732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 698ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich enable_irq(nvec->irq); 699ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 70061c3b1971ad4c71c99919da949ac2043dfac8ee7Prashant Gaikwad clk_disable_unprepare(nvec->i2c_clk); 701ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich} 702ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 703ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrich#ifdef CONFIG_PM_SLEEP 704ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrichstatic void nvec_disable_i2c_slave(struct nvec_chip *nvec) 705ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich{ 706ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich disable_irq(nvec->irq); 707d3f862aec400dd831a4bdbea107fd85419bddab1Julian Andres Klode writel(I2C_SL_NEWSL | I2C_SL_NACK, nvec->base + I2C_SL_CNFG); 70861c3b1971ad4c71c99919da949ac2043dfac8ee7Prashant Gaikwad clk_disable_unprepare(nvec->i2c_clk); 70932890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 710ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrich#endif 71132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 71232890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic void nvec_power_off(void) 71332890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 71432890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec_power_handle, EC_DISABLE_EVENT_REPORTING, 3); 71532890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec_power_handle, "\x04\x01", 2); 71632890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 71732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 71846620803c309d2bc10814b903b39d7647057b440Bill Pembertonstatic int tegra_nvec_probe(struct platform_device *pdev) 71932890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 720f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich int err, ret; 72132890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct clk *i2c_clk; 72232890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_platform_data *pdata = pdev->dev.platform_data; 72332890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec; 72432890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_msg *msg; 725f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich struct resource *res; 726f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich void __iomem *base; 72732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 728f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich nvec = devm_kzalloc(&pdev->dev, sizeof(struct nvec_chip), GFP_KERNEL); 729162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (nvec == NULL) { 73032890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_err(&pdev->dev, "failed to reserve memory\n"); 73132890b983086136fef8721363a2d3860f337ad53Marc Dietrich return -ENOMEM; 73232890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 73332890b983086136fef8721363a2d3860f337ad53Marc Dietrich platform_set_drvdata(pdev, nvec); 73432890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->dev = &pdev->dev; 7357990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich 7367990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich if (pdata) { 7377990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich nvec->gpio = pdata->gpio; 7387990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich nvec->i2c_addr = pdata->i2c_addr; 7397990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich } else if (nvec->dev->of_node) { 740103b748e21ced078f868f9218cef85b0917cebb2Marc Dietrich nvec->gpio = of_get_named_gpio(nvec->dev->of_node, 741103b748e21ced078f868f9218cef85b0917cebb2Marc Dietrich "request-gpios", 0); 7427990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich if (nvec->gpio < 0) { 7437990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich dev_err(&pdev->dev, "no gpio specified"); 744f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich return -ENODEV; 7457990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich } 746103b748e21ced078f868f9218cef85b0917cebb2Marc Dietrich if (of_property_read_u32(nvec->dev->of_node, 747103b748e21ced078f868f9218cef85b0917cebb2Marc Dietrich "slave-addr", &nvec->i2c_addr)) { 7487990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich dev_err(&pdev->dev, "no i2c address specified"); 749f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich return -ENODEV; 7507990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich } 7517990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich } else { 7527990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich dev_err(&pdev->dev, "no platform data\n"); 753f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich return -ENODEV; 7547990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich } 755f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 756f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 757f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (!res) { 758f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(&pdev->dev, "no mem resource?\n"); 759f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich return -ENODEV; 76032890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 76132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 76297f4be60178fec663baaa30a09ae102fd33373c2Thierry Reding base = devm_ioremap_resource(&pdev->dev, res); 76397f4be60178fec663baaa30a09ae102fd33373c2Thierry Reding if (IS_ERR(base)) 76497f4be60178fec663baaa30a09ae102fd33373c2Thierry Reding return PTR_ERR(base); 76532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 766f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich res = platform_get_resource(pdev, IORESOURCE_IRQ, 0); 767f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (!res) { 768f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(&pdev->dev, "no irq resource?\n"); 769f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich return -ENODEV; 770f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich } 77132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 7724344379f63d3bf16d4f2cb3d6b3f3be12704173fMarc Dietrich i2c_clk = clk_get_sys("tegra-i2c.2", "div-clk"); 773f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (IS_ERR(i2c_clk)) { 774f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(nvec->dev, "failed to get controller clock\n"); 775f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich return -ENODEV; 77632890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 77732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 778f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec->base = base; 779f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec->irq = res->start; 780f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec->i2c_clk = i2c_clk; 7810cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx = &nvec->msg_pool[0]; 782f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 78332890b983086136fef8721363a2d3860f337ad53Marc Dietrich ATOMIC_INIT_NOTIFIER_HEAD(&nvec->notifier_list); 78432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 78532890b983086136fef8721363a2d3860f337ad53Marc Dietrich init_completion(&nvec->sync_write); 7860cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode init_completion(&nvec->ec_transfer); 7870cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode mutex_init(&nvec->sync_write_mutex); 7880cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_init(&nvec->tx_lock); 7890cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_init(&nvec->rx_lock); 79032890b983086136fef8721363a2d3860f337ad53Marc Dietrich INIT_LIST_HEAD(&nvec->rx_data); 7910cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode INIT_LIST_HEAD(&nvec->tx_data); 79232890b983086136fef8721363a2d3860f337ad53Marc Dietrich INIT_WORK(&nvec->rx_work, nvec_dispatch); 79332890b983086136fef8721363a2d3860f337ad53Marc Dietrich INIT_WORK(&nvec->tx_work, nvec_request_master); 79432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 795f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich err = devm_gpio_request_one(&pdev->dev, nvec->gpio, GPIOF_OUT_INIT_HIGH, 796f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich "nvec gpio"); 797aed92bbcf4ce760c4d7848013a0db3bdd4ae9492Julian Andres Klode if (err < 0) { 798aed92bbcf4ce760c4d7848013a0db3bdd4ae9492Julian Andres Klode dev_err(nvec->dev, "couldn't request gpio\n"); 799f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich return -ENODEV; 800aed92bbcf4ce760c4d7848013a0db3bdd4ae9492Julian Andres Klode } 801aed92bbcf4ce760c4d7848013a0db3bdd4ae9492Julian Andres Klode 802f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich err = devm_request_irq(&pdev->dev, nvec->irq, nvec_interrupt, 0, 803f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich "nvec", nvec); 804f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (err) { 805f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(nvec->dev, "couldn't request irq\n"); 806f5e3352e5185ef37700da9a51c333559381fe8fdMarc Dietrich return -ENODEV; 807f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich } 808ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich disable_irq(nvec->irq); 809f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 810f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich tegra_init_i2c_slave(nvec); 811f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 81261c3b1971ad4c71c99919da949ac2043dfac8ee7Prashant Gaikwad clk_prepare_enable(i2c_clk); 813ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 814f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 81532890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* enable event reporting */ 81632890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, EC_ENABLE_EVENT_REPORTING, 817162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich sizeof(EC_ENABLE_EVENT_REPORTING)); 81832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 81932890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->nvec_status_notifier.notifier_call = nvec_status_notifier; 82032890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_register_notifier(nvec, &nvec->nvec_status_notifier, 0); 82132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 82232890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_power_handle = nvec; 82332890b983086136fef8721363a2d3860f337ad53Marc Dietrich pm_power_off = nvec_power_off; 82432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 82532890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* Get Firmware Version */ 82632890b983086136fef8721363a2d3860f337ad53Marc Dietrich msg = nvec_write_sync(nvec, EC_GET_FIRMWARE_VERSION, 8270cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode sizeof(EC_GET_FIRMWARE_VERSION)); 82832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 8290cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (msg) { 8300cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_warn(nvec->dev, "ec firmware version %02x.%02x.%02x / %02x\n", 8310cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg->data[4], msg->data[5], msg->data[6], msg->data[7]); 83232890b983086136fef8721363a2d3860f337ad53Marc Dietrich 8330cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_msg_free(nvec, msg); 8340cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 83532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 836f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich ret = mfd_add_devices(nvec->dev, -1, nvec_devices, 8370848c94fb4a5cc213a7fb0fb3a5721ad6e16f096Mark Brown ARRAY_SIZE(nvec_devices), base, 0, NULL); 838162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (ret) 839f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(nvec->dev, "error adding subdevices\n"); 840f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 84132890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* unmute speakers? */ 8426dca320c8f16b464bb762494b509b2b02897054eMarc Dietrich nvec_write_async(nvec, "\x0d\x10\x59\x95", 4); 84332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 84432890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* enable lid switch event */ 84532890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, "\x01\x01\x01\x00\x00\x02\x00", 7); 84632890b983086136fef8721363a2d3860f337ad53Marc Dietrich 84732890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* enable power button event */ 84832890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, "\x01\x01\x01\x00\x00\x80\x00", 7); 84932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 85032890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 85132890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 85232890b983086136fef8721363a2d3860f337ad53Marc Dietrich 8531a6a8a8414f740f1dfde762837eeb3f2ce835919Bill Pembertonstatic int tegra_nvec_remove(struct platform_device *pdev) 85432890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 855f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 856f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 857f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec_write_async(nvec, EC_DISABLE_EVENT_REPORTING, 3); 858f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich mfd_remove_devices(nvec->dev); 859eb1e40a4dd0fb4095900e085fdd3ed259acbee29Tejun Heo cancel_work_sync(&nvec->rx_work); 860eb1e40a4dd0fb4095900e085fdd3ed259acbee29Tejun Heo cancel_work_sync(&nvec->tx_work); 861f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 86232890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 86332890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 86432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 865ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrich#ifdef CONFIG_PM_SLEEP 866ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrichstatic int nvec_suspend(struct device *dev) 86732890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 868ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrich struct platform_device *pdev = to_platform_device(dev); 86932890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 8709feeb0147fe6ae3158db5f319faded5e763744f9Marc Dietrich struct nvec_msg *msg; 87132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 87232890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_dbg(nvec->dev, "suspending\n"); 8739feeb0147fe6ae3158db5f319faded5e763744f9Marc Dietrich 8749feeb0147fe6ae3158db5f319faded5e763744f9Marc Dietrich /* keep these sync or you'll break suspend */ 8759feeb0147fe6ae3158db5f319faded5e763744f9Marc Dietrich msg = nvec_write_sync(nvec, EC_DISABLE_EVENT_REPORTING, 3); 8769feeb0147fe6ae3158db5f319faded5e763744f9Marc Dietrich nvec_msg_free(nvec, msg); 8779feeb0147fe6ae3158db5f319faded5e763744f9Marc Dietrich msg = nvec_write_sync(nvec, "\x04\x02", 2); 8789feeb0147fe6ae3158db5f319faded5e763744f9Marc Dietrich nvec_msg_free(nvec, msg); 8799feeb0147fe6ae3158db5f319faded5e763744f9Marc Dietrich 880ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich nvec_disable_i2c_slave(nvec); 88132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 88232890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 88332890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 88432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 885ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrichstatic int nvec_resume(struct device *dev) 886162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich{ 887ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrich struct platform_device *pdev = to_platform_device(dev); 88832890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 88932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 89032890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_dbg(nvec->dev, "resuming\n"); 891f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich tegra_init_i2c_slave(nvec); 89232890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, EC_ENABLE_EVENT_REPORTING, 3); 89332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 89432890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 89532890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 89632890b983086136fef8721363a2d3860f337ad53Marc Dietrich#endif 89732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 898ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrichstatic const SIMPLE_DEV_PM_OPS(nvec_pm_ops, nvec_suspend, nvec_resume); 899ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrich 9007990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich/* Match table for of_platform binding */ 901063f9f6a8705c5da3ee46c667a3e6e01eaf31560Bill Pembertonstatic const struct of_device_id nvidia_nvec_of_match[] = { 9027990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich { .compatible = "nvidia,nvec", }, 9037990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich {}, 9047990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich}; 9057990b0d7ec449b10da383bab191eb487185aadceMarc DietrichMODULE_DEVICE_TABLE(of, nvidia_nvec_of_match); 9067990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich 907162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic struct platform_driver nvec_device_driver = { 908162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .probe = tegra_nvec_probe, 90944b90a3fbcac0f233b71b4041fa76ea325caca33Bill Pemberton .remove = tegra_nvec_remove, 910162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .driver = { 91132890b983086136fef8721363a2d3860f337ad53Marc Dietrich .name = "nvec", 91232890b983086136fef8721363a2d3860f337ad53Marc Dietrich .owner = THIS_MODULE, 913ebefae28cea729cb1fa9c944179f62d7dd65b10fMarc Dietrich .pm = &nvec_pm_ops, 9147990b0d7ec449b10da383bab191eb487185aadceMarc Dietrich .of_match_table = nvidia_nvec_of_match, 91532890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 91632890b983086136fef8721363a2d3860f337ad53Marc Dietrich}; 91732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 9189891b1ce6276912c54f66b7b0c8c1bcc42ca75ebMarc Dietrichmodule_platform_driver(nvec_device_driver); 919162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 92032890b983086136fef8721363a2d3860f337ad53Marc DietrichMODULE_ALIAS("platform:nvec"); 921162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc DietrichMODULE_DESCRIPTION("NVIDIA compliant embedded controller interface"); 922162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc DietrichMODULE_AUTHOR("Marc Dietrich <marvin24@gmx.de>"); 923162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc DietrichMODULE_LICENSE("GPL"); 924