nvec.c revision bdf034d98676d143cb88f7b999a71fff5775fcd4
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 1932890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <asm/irq.h> 20162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 210b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode#include <linux/atomic.h> 2232890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/completion.h> 2332890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/interrupt.h> 24162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich#include <linux/io.h> 2532890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/irq.h> 2632890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/slab.h> 2732890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/gpio.h> 2832890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/serio.h> 2932890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/delay.h> 3032890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/input.h> 3132890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/workqueue.h> 3232890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/clk.h> 33162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 3432890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/semaphore.h> 3532890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/list.h> 3632890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/notifier.h> 3732890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include <linux/platform_device.h> 38f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich#include <linux/mfd/core.h> 39162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 40162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich#include <mach/iomap.h> 41162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich#include <mach/clk.h> 42162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 4332890b983086136fef8721363a2d3860f337ad53Marc Dietrich#include "nvec.h" 4432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 45162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic const unsigned char EC_DISABLE_EVENT_REPORTING[3] = "\x04\x00\x00"; 46162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic const unsigned char EC_ENABLE_EVENT_REPORTING[3] = "\x04\x00\x01"; 47162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic const unsigned char EC_GET_FIRMWARE_VERSION[2] = "\x07\x15"; 4832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 4932890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic struct nvec_chip *nvec_power_handle; 5032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 51f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrichstatic struct mfd_cell nvec_devices[] = { 52f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich { 53162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .name = "nvec-kbd", 54162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .id = 1, 55f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich }, 56f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich { 57162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .name = "nvec-mouse", 58162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .id = 1, 59f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich }, 60f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich { 61162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .name = "nvec-power", 62162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .id = 1, 63f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich }, 64f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich { 65162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .name = "nvec-power", 66162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .id = 2, 67f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich }, 6897cc26576fa2b0eb1aad1b29515bb0a32f86c45cIlya Petrov { 6997cc26576fa2b0eb1aad1b29515bb0a32f86c45cIlya Petrov .name = "nvec-leds", 7097cc26576fa2b0eb1aad1b29515bb0a32f86c45cIlya Petrov .id = 1, 7197cc26576fa2b0eb1aad1b29515bb0a32f86c45cIlya Petrov }, 72f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich}; 73f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 74bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 75bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_register_notifier - Register a notifier with nvec 76bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 77bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nb: The notifier block to register 78bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 79bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Registers a notifier with @nvec. The notifier will be added to an atomic 80bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * notifier chain that is called for all received messages except those that 81bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * correspond to a request initiated by nvec_write_sync(). 82bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 8332890b983086136fef8721363a2d3860f337ad53Marc Dietrichint nvec_register_notifier(struct nvec_chip *nvec, struct notifier_block *nb, 84162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich unsigned int events) 8532890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 8632890b983086136fef8721363a2d3860f337ad53Marc Dietrich return atomic_notifier_chain_register(&nvec->notifier_list, nb); 8732890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 8832890b983086136fef8721363a2d3860f337ad53Marc DietrichEXPORT_SYMBOL_GPL(nvec_register_notifier); 8932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 90bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 91bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_status_notifier - The final notifier 92bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 93bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Prints a message about control events not handled in the notifier 94bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * chain. 95bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 96162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic int nvec_status_notifier(struct notifier_block *nb, 97162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich unsigned long event_type, void *data) 9832890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 9932890b983086136fef8721363a2d3860f337ad53Marc Dietrich unsigned char *msg = (unsigned char *)data; 10032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 101162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (event_type != NVEC_CNTL) 10232890b983086136fef8721363a2d3860f337ad53Marc Dietrich return NOTIFY_DONE; 10332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 104a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich printk(KERN_WARNING "unhandled msg type %ld\n", event_type); 105a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich print_hex_dump(KERN_WARNING, "payload: ", DUMP_PREFIX_NONE, 16, 1, 106a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich msg, msg[1] + 2, true); 10732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 10832890b983086136fef8721363a2d3860f337ad53Marc Dietrich return NOTIFY_OK; 10932890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 11032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 111bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 112bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_msg_alloc: 113bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 114bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 115bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Allocate a single &struct nvec_msg object from the message pool of 116bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec. The result shall be passed to nvec_msg_free() if no longer 117bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * used. 118bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 1190b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klodestatic struct nvec_msg *nvec_msg_alloc(struct nvec_chip *nvec) 1200b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode{ 1210b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode int i; 1220b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 1230b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode for (i = 0; i < NVEC_POOL_SIZE; i++) { 1240b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode if (atomic_xchg(&nvec->msg_pool[i].used, 1) == 0) { 1250b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode dev_vdbg(nvec->dev, "INFO: Allocate %i\n", i); 1260b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode return &nvec->msg_pool[i]; 1270b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode } 1280b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode } 1290b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 1300b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode dev_err(nvec->dev, "could not allocate buffer\n"); 1310b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 1320b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode return NULL; 1330b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode} 1340b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 135bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 136bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_msg_free: 137bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 138bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @msg: A message (must be allocated by nvec_msg_alloc() and belong to @nvec) 139bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 140bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Free the given message 141bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 1420b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klodestatic void nvec_msg_free(struct nvec_chip *nvec, struct nvec_msg *msg) 1430b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode{ 1447b77065793b8de101c7be3829b4ff8a4618a7172Julian Andres Klode if (msg != &nvec->tx_scratch) 1457b77065793b8de101c7be3829b4ff8a4618a7172Julian Andres Klode dev_vdbg(nvec->dev, "INFO: Free %ti\n", msg - nvec->msg_pool); 1460b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode atomic_set(&msg->used, 0); 1470b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode} 1480b1076c4b2a06e517fafbb2b4704f23e69b05386Julian Andres Klode 1498517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode/** 1508517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * nvec_msg_is_event - Return %true if @msg is an event 1518517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * @msg: A message 1528517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode */ 1538517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klodestatic bool nvec_msg_is_event(struct nvec_msg *msg) 1548517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode{ 1558517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return msg->data[0] >> 7; 1568517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode} 1578517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode 1588517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode/** 1598517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * nvec_msg_size - Get the size of a message 1608517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * @msg: The message to get the size for 1618517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * 1628517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode * This only works for received messages, not for outgoing messages. 1638517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode */ 1648517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klodestatic size_t nvec_msg_size(struct nvec_msg *msg) 1658517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode{ 1668517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode bool is_event = nvec_msg_is_event(msg); 1678517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode int event_length = (msg->data[0] & 0x60) >> 5; 1688517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode 1698517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode /* for variable size, payload size in byte 1 + count (1) + cmd (1) */ 1708517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode if (!is_event || event_length == NVEC_VAR_SIZE) 1718517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return (msg->pos || msg->size) ? (msg->data[1] + 2) : 0; 1728517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode else if (event_length == NVEC_2BYTES) 1738517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return 2; 1748517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode else if (event_length == NVEC_3BYTES) 1758517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return 3; 1768517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode else 1778517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode return 0; 1788517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode} 1798517e879e0d11a277275616b9e1c749afe2fceffJulian Andres Klode 180bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 181bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_gpio_set_value - Set the GPIO value 182bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 183bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @value: The value to write (0 or 1) 184bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 185bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Like gpio_set_value(), but generating debugging information 186bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 187e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klodestatic void nvec_gpio_set_value(struct nvec_chip *nvec, int value) 188e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode{ 189e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode dev_dbg(nvec->dev, "GPIO changed from %u to %u\n", 190e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode gpio_get_value(nvec->gpio), value); 191e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode gpio_set_value(nvec->gpio, value); 192e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode} 193e7c40851fd7989dad297988b6343f4e3cb687292Julian Andres Klode 194bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 195bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_write_async - Asynchronously write a message to NVEC 196bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: An nvec_chip instance 197bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @data: The message data, starting with the request type 198bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @size: The size of @data 199bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 200bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Queue a single message to be transferred to the embedded controller 201bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * and return immediately. 202bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 203bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Returns: 0 on success, a negative error code on failure. If a failure 204bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * occured, the nvec driver may print an error. 205bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 2061b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klodeint nvec_write_async(struct nvec_chip *nvec, const unsigned char *data, 207162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich short size) 20832890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 2090cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode struct nvec_msg *msg; 2100cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned long flags; 21132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 2120cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg = nvec_msg_alloc(nvec); 2131b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode if (msg == NULL) 2141b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode return -ENOMEM; 2151b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode 21632890b983086136fef8721363a2d3860f337ad53Marc Dietrich msg->data[0] = size; 21732890b983086136fef8721363a2d3860f337ad53Marc Dietrich memcpy(msg->data + 1, data, size); 21832890b983086136fef8721363a2d3860f337ad53Marc Dietrich msg->size = size + 1; 21932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 2200cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 22132890b983086136fef8721363a2d3860f337ad53Marc Dietrich list_add_tail(&msg->node, &nvec->tx_data); 2220cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 22332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 2240cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode queue_work(nvec->wq, &nvec->tx_work); 2251b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode 2261b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode return 0; 22732890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 22832890b983086136fef8721363a2d3860f337ad53Marc DietrichEXPORT_SYMBOL(nvec_write_async); 22932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 230bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 231bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_write_sync - Write a message to nvec and read the response 232bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: An &struct nvec_chip 233bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @data: The data to write 234bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @size: The size of @data 235bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 236bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * This is similar to nvec_write_async(), but waits for the 237bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * request to be answered before returning. This function 238bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * uses a mutex and can thus not be called from e.g. 239bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * interrupt handlers. 240bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 241bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Returns: A pointer to the response message on success, 242bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * %NULL on failure. 243bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 2440cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestruct nvec_msg *nvec_write_sync(struct nvec_chip *nvec, 2450cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode const unsigned char *data, short size) 2460cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 2470cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode struct nvec_msg *msg; 2480cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2490cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode mutex_lock(&nvec->sync_write_mutex); 2500cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->sync_write_pending = (data[1] << 8) + data[0]; 2521b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode 2531b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode if (nvec_write_async(nvec, data, size) < 0) 2541b9bf629ea42fdacd951b9190f86b028557bbe19Julian Andres Klode return NULL; 2550cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2560cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_dbg(nvec->dev, "nvec_sync_write: 0x%04x\n", 2570cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->sync_write_pending); 2580cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (!(wait_for_completion_timeout(&nvec->sync_write, 2590cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msecs_to_jiffies(2000)))) { 2600cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_warn(nvec->dev, "timeout waiting for sync write to complete\n"); 2610cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode mutex_unlock(&nvec->sync_write_mutex); 2620cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode return NULL; 2630cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 2640cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2650cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_dbg(nvec->dev, "nvec_sync_write: pong!\n"); 2660cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2670cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg = nvec->last_sync_msg; 2680cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2690cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode mutex_unlock(&nvec->sync_write_mutex); 2700cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2710cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode return msg; 2720cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 2730cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres KlodeEXPORT_SYMBOL(nvec_write_sync); 2740cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 275bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 276bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_request_master - Process outgoing messages 277bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @work: A &struct work_struct (the tx_worker member of &struct nvec_chip) 278bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 279bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Processes all outgoing requests by sending the request and awaiting the 280bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * response, then continuing with the next request. Once a request has a 281bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * matching response, it will be freed and removed from the list. 282bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 28332890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic void nvec_request_master(struct work_struct *work) 28432890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 28532890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec = container_of(work, struct nvec_chip, tx_work); 2860cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned long flags; 2870cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode long err; 2880cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode struct nvec_msg *msg; 2890cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2900cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 2910cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode while (!list_empty(&nvec->tx_data)) { 2920cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg = list_first_entry(&nvec->tx_data, struct nvec_msg, node); 2930cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 2940cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_gpio_set_value(nvec, 0); 2950cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode err = wait_for_completion_interruptible_timeout( 2960cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode &nvec->ec_transfer, msecs_to_jiffies(5000)); 2970cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 2980cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (err == 0) { 2990cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_warn(nvec->dev, "timeout waiting for ec transfer\n"); 3000cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_gpio_set_value(nvec, 1); 3010cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg->pos = 0; 3020cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 30332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 3040cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 3050cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 3060cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (err > 0) { 3070cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode list_del_init(&msg->node); 3080cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_msg_free(nvec, msg); 3090cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 3100cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 3110cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 31232890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 31332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 314bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 315bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * parse_msg - Print some information and call the notifiers on an RX message 316bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 317bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @msg: A message received by @nvec 318bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 319bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Paarse some pieces of the message and then call the chain of notifiers 320bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * registered via nvec_register_notifier. 321bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 32232890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic int parse_msg(struct nvec_chip *nvec, struct nvec_msg *msg) 32332890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 324162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if ((msg->data[0] & 1 << 7) == 0 && msg->data[3]) { 325162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich dev_err(nvec->dev, "ec responded %02x %02x %02x %02x\n", 326162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich msg->data[0], msg->data[1], msg->data[2], msg->data[3]); 32732890b983086136fef8721363a2d3860f337ad53Marc Dietrich return -EINVAL; 32832890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 32932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 330a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich if ((msg->data[0] >> 7) == 1 && (msg->data[0] & 0x0f) == 5) 331a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich print_hex_dump(KERN_WARNING, "ec system event ", 332a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich DUMP_PREFIX_NONE, 16, 1, msg->data, 333a3a9aa1a41429b17aa1af20995850ea1b68d5ba2Marc Dietrich msg->data[1] + 2, true); 33432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 335162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich atomic_notifier_call_chain(&nvec->notifier_list, msg->data[0] & 0x8f, 336162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich msg->data); 33732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 33832890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 33932890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 34032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 341bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 342bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_dispatch - Process messages received from the EC 343bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @work: A &struct work_struct (the tx_worker member of &struct nvec_chip) 344bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 345bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Process messages previously received from the EC and put into the RX 346bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * queue of the &struct nvec_chip instance associated with @work. 347bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 34832890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic void nvec_dispatch(struct work_struct *work) 34932890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 35032890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec = container_of(work, struct nvec_chip, rx_work); 3510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned long flags; 35232890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_msg *msg; 35332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 3540cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->rx_lock, flags); 355162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich while (!list_empty(&nvec->rx_data)) { 35632890b983086136fef8721363a2d3860f337ad53Marc Dietrich msg = list_first_entry(&nvec->rx_data, struct nvec_msg, node); 35732890b983086136fef8721363a2d3860f337ad53Marc Dietrich list_del_init(&msg->node); 3580cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->rx_lock, flags); 35932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 360162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (nvec->sync_write_pending == 3610cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (msg->data[2] << 8) + msg->data[0]) { 36232890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_dbg(nvec->dev, "sync write completed!\n"); 36332890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->sync_write_pending = 0; 36432890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->last_sync_msg = msg; 36532890b983086136fef8721363a2d3860f337ad53Marc Dietrich complete(&nvec->sync_write); 36632890b983086136fef8721363a2d3860f337ad53Marc Dietrich } else { 36732890b983086136fef8721363a2d3860f337ad53Marc Dietrich parse_msg(nvec, msg); 3680cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_msg_free(nvec, msg); 36932890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 3700cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_irqsave(&nvec->rx_lock, flags); 37132890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 3720cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock_irqrestore(&nvec->rx_lock, flags); 37332890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 37432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 375bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 376bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_tx_completed - Complete the current transfer 377bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 378bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 379bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * This is called when we have received an END_TRANS on a TX transfer. 380bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 3810cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestatic void nvec_tx_completed(struct nvec_chip *nvec) 3820cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 3830cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* We got an END_TRANS, let's skip this, maybe there's an event */ 3840cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (nvec->tx->pos != nvec->tx->size) { 3850cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "premature END_TRANS, resending\n"); 3860cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx->pos = 0; 3870cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_gpio_set_value(nvec, 0); 3880cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else { 3890cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 3900cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 3910cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 3920cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 393bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode/** 394bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * nvec_rx_completed - Complete the current transfer 395bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 396bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 397bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * This is called when we have received an END_TRANS on a RX transfer. 398bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode */ 3990cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestatic void nvec_rx_completed(struct nvec_chip *nvec) 4000cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 4010cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (nvec->rx->pos != nvec_msg_size(nvec->rx)) 4020cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "RX incomplete: Expected %u bytes, got %u\n", 4030cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint) nvec_msg_size(nvec->rx), 4040cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint) nvec->rx->pos); 4050cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4060cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock(&nvec->rx_lock); 4070cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4080cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* add the received data to the work list 4090cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode and move the ring buffer pointer to the next entry */ 4100cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode list_add_tail(&nvec->rx->node, &nvec->rx_data); 4110cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4120cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock(&nvec->rx_lock); 4130cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4140cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 4150cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4160cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (!nvec_msg_is_event(nvec->rx)) 4170cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode complete(&nvec->ec_transfer); 4180cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4190cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode queue_work(nvec->wq, &nvec->rx_work); 4200cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 4210cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4220cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode/** 4230cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * nvec_invalid_flags - Send an error message about invalid flags and jump 4240cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @nvec: The nvec device 4250cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @status: The status flags 4260cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @reset: Whether we shall jump to state 0. 4270cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode */ 4280cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestatic void nvec_invalid_flags(struct nvec_chip *nvec, unsigned int status, 4290cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode bool reset) 4300cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 4310cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "unexpected status flags 0x%02x during state %i\n", 4320cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status, nvec->state); 4330cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (reset) 4340cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 4350cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 4360cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4370cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode/** 4380cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * nvec_tx_set - Set the message to transfer (nvec->tx) 439bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * @nvec: A &struct nvec_chip 440bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 441bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Gets the first entry from the tx_data list of @nvec and sets the 442bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * tx member to it. If the tx_data list is empty, this uses the 443bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * tx_scratch message to send a no operation message. 4440cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode */ 4450cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klodestatic void nvec_tx_set(struct nvec_chip *nvec) 4460cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode{ 4470cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock(&nvec->tx_lock); 4480cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (list_empty(&nvec->tx_data)) { 4490cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "empty tx - sending no-op\n"); 4500cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode memcpy(nvec->tx_scratch.data, "\x02\x07\x02", 3); 4510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx_scratch.size = 3; 4520cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx_scratch.pos = 0; 4530cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx = &nvec->tx_scratch; 4540cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode list_add_tail(&nvec->tx->node, &nvec->tx_data); 4550cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else { 4560cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx = list_first_entry(&nvec->tx_data, struct nvec_msg, 4570cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode node); 4580cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx->pos = 0; 4590cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 4600cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_unlock(&nvec->tx_lock); 4610cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4620cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_dbg(nvec->dev, "Sending message of length %u, command 0x%x\n", 4630cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint)nvec->tx->size, nvec->tx->data[1]); 4640cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode} 4650cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 4660cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode/** 4670cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * nvec_interrupt - Interrupt handler 4680cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @irq: The IRQ 4690cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode * @dev: The nvec device 470bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * 471bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * Interrupt handler that fills our RX buffers and empties our TX 472bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * buffers. This uses a finite state machine with ridiculous amounts 473bdf034d98676d143cb88f7b999a71fff5775fcd4Julian Andres Klode * of error checking, in order to be fairly reliable. 4740cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode */ 475f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrichstatic irqreturn_t nvec_interrupt(int irq, void *dev) 47632890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 47732890b983086136fef8721363a2d3860f337ad53Marc Dietrich unsigned long status; 4780cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned int received = 0; 4790cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned char to_send = 0xff; 4800cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode const unsigned long irq_mask = I2C_SL_IRQ | END_TRANS | RCVD | RNW; 4810cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode struct nvec_chip *nvec = dev; 4820cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode unsigned int state = nvec->state; 48332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 4840cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status = readl(nvec->base + I2C_SL_STATUS); 48532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 4860cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* Filter out some errors */ 4870cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & irq_mask) == 0 && (status & ~irq_mask) != 0) { 4880cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "unexpected irq mask %lx\n", status); 4890cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode return IRQ_HANDLED; 49032890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 4910cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & I2C_SL_IRQ) == 0) { 4920cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "Spurious IRQ\n"); 49332890b983086136fef8721363a2d3860f337ad53Marc Dietrich return IRQ_HANDLED; 4940cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 49532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 4960cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* The EC did not request a read, so it send us something, read it */ 4970cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & RNW) == 0) { 4980cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode received = readl(nvec->base + I2C_SL_RCVD); 499162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (status & RCVD) 5000cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode writel(0, nvec->base + I2C_SL_RCVD); 5010cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 502162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 5030cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status == (I2C_SL_IRQ | RCVD)) 5040cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 5050cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 5060cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode switch (nvec->state) { 5070cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 0: /* Verify that its a transfer start, the rest later */ 5080cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status != (I2C_SL_IRQ | RCVD)) 5090cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, false); 5100cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 5110cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 1: /* command byte */ 5120cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status != I2C_SL_IRQ) { 5130cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, true); 51432890b983086136fef8721363a2d3860f337ad53Marc Dietrich } else { 5150cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx = nvec_msg_alloc(nvec); 5160cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->data[0] = received; 5170cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->pos = 1; 5180cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 2; 5190cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 5200cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 5210cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 2: /* first byte after command */ 5220cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status == (I2C_SL_IRQ | RNW | RCVD)) { 5230cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode udelay(33); 5240cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (nvec->rx->data[0] != 0x01) { 5250cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, 5260cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "Read without prior read command\n"); 5270cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 5280cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 52932890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 5300cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_msg_free(nvec, nvec->rx); 5310cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 3; 5320cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_tx_set(nvec); 5330cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode BUG_ON(nvec->tx->size < 1); 5340cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode to_send = nvec->tx->data[0]; 5350cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx->pos = 1; 5360cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else if (status == (I2C_SL_IRQ)) { 5370cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode BUG_ON(nvec->rx == NULL); 5380cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->data[1] = received; 5390cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->pos = 2; 5400cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 4; 5410cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else { 5420cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, true); 54332890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 5440cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 5450cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 3: /* EC does a block read, we transmit data */ 5460cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status & END_TRANS) { 5470cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_tx_completed(nvec); 5480cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else if ((status & RNW) == 0 || (status & RCVD)) { 5490cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, true); 5500cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else if (nvec->tx && nvec->tx->pos < nvec->tx->size) { 5510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode to_send = nvec->tx->data[nvec->tx->pos++]; 5520cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } else { 5530cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, "tx buffer underflow on %p (%u > %u)\n", 5540cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->tx, 5550cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint) (nvec->tx ? nvec->tx->pos : 0), 5560cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (uint) (nvec->tx ? nvec->tx->size : 0)); 5570cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 55832890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 5590cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 5600cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode case 4: /* EC does some write, we read the data */ 5610cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & (END_TRANS | RNW)) == END_TRANS) 5620cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_rx_completed(nvec); 5630cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode else if (status & (RNW | RCVD)) 5640cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_invalid_flags(nvec, status, true); 5650cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode else if (nvec->rx && nvec->rx->pos < NVEC_MSG_SIZE) 5660cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx->data[nvec->rx->pos++] = received; 5670cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode else 5680cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, 5690cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "RX buffer overflow on %p: " 5700cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "Trying to write byte %u of %u\n", 5710cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx, nvec->rx->pos, NVEC_MSG_SIZE); 5720cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode break; 5730cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode default: 5740cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 0; 5750cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 57632890b983086136fef8721363a2d3860f337ad53Marc Dietrich 5770cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* If we are told that a new transfer starts, verify it */ 5780cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & (RCVD | RNW)) == RCVD) { 5790cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (received != nvec->i2c_addr) 5800cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_err(nvec->dev, 5810cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "received address 0x%02x, expected 0x%02x\n", 5820cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode received, nvec->i2c_addr); 5830cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->state = 1; 58432890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 5850cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 5860cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* Send data if requested, but not on end of transmission */ 5870cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if ((status & (RNW | END_TRANS)) == RNW) 5880cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode writel(to_send, nvec->base + I2C_SL_RCVD); 5890cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 5900cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode /* If we have send the first byte */ 5910cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (status == (I2C_SL_IRQ | RNW | RCVD)) 5920cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_gpio_set_value(nvec, 1); 5930cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 5940cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_dbg(nvec->dev, 5950cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode "Handled: %s 0x%02x, %s 0x%02x in state %u [%s%s%s]\n", 5960cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (status & RNW) == 0 ? "received" : "R=", 5970cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode received, 5980cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode (status & (RNW | END_TRANS)) ? "sent" : "S=", 5990cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode to_send, 6000cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode state, 6010cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status & END_TRANS ? " END_TRANS" : "", 6020cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status & RCVD ? " RCVD" : "", 6030cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode status & RNW ? " RNW" : ""); 6040cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode 60532890b983086136fef8721363a2d3860f337ad53Marc Dietrich return IRQ_HANDLED; 60632890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 60732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 608f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrichstatic void tegra_init_i2c_slave(struct nvec_chip *nvec) 60932890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 61032890b983086136fef8721363a2d3860f337ad53Marc Dietrich u32 val; 61132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 612f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich clk_enable(nvec->i2c_clk); 613f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 614f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich tegra_periph_reset_assert(nvec->i2c_clk); 61532890b983086136fef8721363a2d3860f337ad53Marc Dietrich udelay(2); 616f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich tegra_periph_reset_deassert(nvec->i2c_clk); 61732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 61832890b983086136fef8721363a2d3860f337ad53Marc Dietrich val = I2C_CNFG_NEW_MASTER_SFM | I2C_CNFG_PACKET_MODE_EN | 619ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich (0x2 << I2C_CNFG_DEBOUNCE_CNT_SHIFT); 620f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich writel(val, nvec->base + I2C_CNFG); 621ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 622ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich clk_set_rate(nvec->i2c_clk, 8 * 80000); 623ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 624f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich writel(I2C_SL_NEWL, nvec->base + I2C_SL_CNFG); 625ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich writel(0x1E, nvec->base + I2C_SL_DELAY_COUNT); 626ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 627ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich writel(nvec->i2c_addr>>1, nvec->base + I2C_SL_ADDR1); 628ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich writel(0, nvec->base + I2C_SL_ADDR2); 62932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 630ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich enable_irq(nvec->irq); 631ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 632ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich clk_disable(nvec->i2c_clk); 633ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich} 634ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 635ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrichstatic void nvec_disable_i2c_slave(struct nvec_chip *nvec) 636ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich{ 637ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich disable_irq(nvec->irq); 638ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich writel(I2C_SL_NEWL | I2C_SL_NACK, nvec->base + I2C_SL_CNFG); 639f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich clk_disable(nvec->i2c_clk); 64032890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 64132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 64232890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic void nvec_power_off(void) 64332890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 64432890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec_power_handle, EC_DISABLE_EVENT_REPORTING, 3); 64532890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec_power_handle, "\x04\x01", 2); 64632890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 64732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 64832890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic int __devinit tegra_nvec_probe(struct platform_device *pdev) 64932890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 650f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich int err, ret; 65132890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct clk *i2c_clk; 65232890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_platform_data *pdata = pdev->dev.platform_data; 65332890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec; 65432890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_msg *msg; 655f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich struct resource *res; 656f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich struct resource *iomem; 657f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich void __iomem *base; 65832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 65932890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec = kzalloc(sizeof(struct nvec_chip), GFP_KERNEL); 660162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (nvec == NULL) { 66132890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_err(&pdev->dev, "failed to reserve memory\n"); 66232890b983086136fef8721363a2d3860f337ad53Marc Dietrich return -ENOMEM; 66332890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 66432890b983086136fef8721363a2d3860f337ad53Marc Dietrich platform_set_drvdata(pdev, nvec); 66532890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->dev = &pdev->dev; 66632890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->gpio = pdata->gpio; 667f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec->i2c_addr = pdata->i2c_addr; 668f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 669f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 670f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (!res) { 671f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(&pdev->dev, "no mem resource?\n"); 672f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich return -ENODEV; 67332890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 67432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 675f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich iomem = request_mem_region(res->start, resource_size(res), pdev->name); 676f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (!iomem) { 677f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(&pdev->dev, "I2C region already claimed\n"); 678f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich return -EBUSY; 679f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich } 68032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 681f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich base = ioremap(iomem->start, resource_size(iomem)); 682f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (!base) { 683f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(&pdev->dev, "Can't ioremap I2C region\n"); 684f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich return -ENOMEM; 68532890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 68632890b983086136fef8721363a2d3860f337ad53Marc Dietrich 687f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich res = platform_get_resource(pdev, IORESOURCE_IRQ, 0); 688f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (!res) { 689f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(&pdev->dev, "no irq resource?\n"); 690f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich ret = -ENODEV; 691f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich goto err_iounmap; 692f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich } 69332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 694f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich i2c_clk = clk_get_sys("tegra-i2c.2", NULL); 695f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (IS_ERR(i2c_clk)) { 696f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(nvec->dev, "failed to get controller clock\n"); 697f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich goto err_iounmap; 69832890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 69932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 700f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec->base = base; 701f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec->irq = res->start; 702f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec->i2c_clk = i2c_clk; 7030cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->rx = &nvec->msg_pool[0]; 704f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 70532890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* Set the gpio to low when we've got something to say */ 70632890b983086136fef8721363a2d3860f337ad53Marc Dietrich err = gpio_request(nvec->gpio, "nvec gpio"); 707162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (err < 0) 70832890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_err(nvec->dev, "couldn't request gpio\n"); 70932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 71032890b983086136fef8721363a2d3860f337ad53Marc Dietrich ATOMIC_INIT_NOTIFIER_HEAD(&nvec->notifier_list); 71132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 71232890b983086136fef8721363a2d3860f337ad53Marc Dietrich init_completion(&nvec->sync_write); 7130cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode init_completion(&nvec->ec_transfer); 7140cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode mutex_init(&nvec->sync_write_mutex); 7150cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_init(&nvec->tx_lock); 7160cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode spin_lock_init(&nvec->rx_lock); 71732890b983086136fef8721363a2d3860f337ad53Marc Dietrich INIT_LIST_HEAD(&nvec->rx_data); 7180cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode INIT_LIST_HEAD(&nvec->tx_data); 71932890b983086136fef8721363a2d3860f337ad53Marc Dietrich INIT_WORK(&nvec->rx_work, nvec_dispatch); 72032890b983086136fef8721363a2d3860f337ad53Marc Dietrich INIT_WORK(&nvec->tx_work, nvec_request_master); 7210cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec->wq = alloc_workqueue("nvec", WQ_NON_REENTRANT, 2); 72232890b983086136fef8721363a2d3860f337ad53Marc Dietrich 723f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich err = request_irq(nvec->irq, nvec_interrupt, 0, "nvec", nvec); 724f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich if (err) { 725f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(nvec->dev, "couldn't request irq\n"); 726f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich goto failed; 727f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich } 728ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich disable_irq(nvec->irq); 729f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 730f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich tegra_init_i2c_slave(nvec); 731f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 732ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich clk_enable(i2c_clk); 733ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich 734f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich gpio_direction_output(nvec->gpio, 1); 735f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich gpio_set_value(nvec->gpio, 1); 736f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 73732890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* enable event reporting */ 73832890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, EC_ENABLE_EVENT_REPORTING, 739162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich sizeof(EC_ENABLE_EVENT_REPORTING)); 74032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 74132890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec->nvec_status_notifier.notifier_call = nvec_status_notifier; 74232890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_register_notifier(nvec, &nvec->nvec_status_notifier, 0); 74332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 74432890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_power_handle = nvec; 74532890b983086136fef8721363a2d3860f337ad53Marc Dietrich pm_power_off = nvec_power_off; 74632890b983086136fef8721363a2d3860f337ad53Marc Dietrich 74732890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* Get Firmware Version */ 74832890b983086136fef8721363a2d3860f337ad53Marc Dietrich msg = nvec_write_sync(nvec, EC_GET_FIRMWARE_VERSION, 7490cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode sizeof(EC_GET_FIRMWARE_VERSION)); 75032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 7510cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode if (msg) { 7520cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode dev_warn(nvec->dev, "ec firmware version %02x.%02x.%02x / %02x\n", 7530cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode msg->data[4], msg->data[5], msg->data[6], msg->data[7]); 75432890b983086136fef8721363a2d3860f337ad53Marc Dietrich 7550cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode nvec_msg_free(nvec, msg); 7560cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode } 75732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 758f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich ret = mfd_add_devices(nvec->dev, -1, nvec_devices, 759162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich ARRAY_SIZE(nvec_devices), base, 0); 760162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich if (ret) 761f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich dev_err(nvec->dev, "error adding subdevices\n"); 762f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 76332890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* unmute speakers? */ 7646dca320c8f16b464bb762494b509b2b02897054eMarc Dietrich nvec_write_async(nvec, "\x0d\x10\x59\x95", 4); 76532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 76632890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* enable lid switch event */ 76732890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, "\x01\x01\x01\x00\x00\x02\x00", 7); 76832890b983086136fef8721363a2d3860f337ad53Marc Dietrich 76932890b983086136fef8721363a2d3860f337ad53Marc Dietrich /* enable power button event */ 77032890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, "\x01\x01\x01\x00\x00\x80\x00", 7); 77132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 77232890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 77332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 774f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietricherr_iounmap: 775f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich iounmap(base); 77632890b983086136fef8721363a2d3860f337ad53Marc Dietrichfailed: 77732890b983086136fef8721363a2d3860f337ad53Marc Dietrich kfree(nvec); 77832890b983086136fef8721363a2d3860f337ad53Marc Dietrich return -ENOMEM; 77932890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 78032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 78132890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic int __devexit tegra_nvec_remove(struct platform_device *pdev) 78232890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 783f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 784f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 785f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich nvec_write_async(nvec, EC_DISABLE_EVENT_REPORTING, 3); 786f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich mfd_remove_devices(nvec->dev); 787f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich free_irq(nvec->irq, &nvec_interrupt); 788f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich iounmap(nvec->base); 789f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich gpio_free(nvec->gpio); 7900cab4cb8526d7367c912c9a871d3ad1a9ac1fbf0Julian Andres Klode destroy_workqueue(nvec->wq); 791f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich kfree(nvec); 792f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich 79332890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 79432890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 79532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 79632890b983086136fef8721363a2d3860f337ad53Marc Dietrich#ifdef CONFIG_PM 79732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 79832890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic int tegra_nvec_suspend(struct platform_device *pdev, pm_message_t state) 79932890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 80032890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 80132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 80232890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_dbg(nvec->dev, "suspending\n"); 80332890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, EC_DISABLE_EVENT_REPORTING, 3); 80432890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, "\x04\x02", 2); 805ac8107599e47b0f4638f4f3fb0141bbcf0cb142bMarc Dietrich nvec_disable_i2c_slave(nvec); 80632890b983086136fef8721363a2d3860f337ad53Marc Dietrich 80732890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 80832890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 80932890b983086136fef8721363a2d3860f337ad53Marc Dietrich 810162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic int tegra_nvec_resume(struct platform_device *pdev) 811162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich{ 81232890b983086136fef8721363a2d3860f337ad53Marc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 81332890b983086136fef8721363a2d3860f337ad53Marc Dietrich 81432890b983086136fef8721363a2d3860f337ad53Marc Dietrich dev_dbg(nvec->dev, "resuming\n"); 815f686e9affba24cfdf94fb155aaeb36a1e14719f1Marc Dietrich tegra_init_i2c_slave(nvec); 81632890b983086136fef8721363a2d3860f337ad53Marc Dietrich nvec_write_async(nvec, EC_ENABLE_EVENT_REPORTING, 3); 81732890b983086136fef8721363a2d3860f337ad53Marc Dietrich 81832890b983086136fef8721363a2d3860f337ad53Marc Dietrich return 0; 81932890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 82032890b983086136fef8721363a2d3860f337ad53Marc Dietrich 82132890b983086136fef8721363a2d3860f337ad53Marc Dietrich#else 82232890b983086136fef8721363a2d3860f337ad53Marc Dietrich#define tegra_nvec_suspend NULL 82332890b983086136fef8721363a2d3860f337ad53Marc Dietrich#define tegra_nvec_resume NULL 82432890b983086136fef8721363a2d3860f337ad53Marc Dietrich#endif 82532890b983086136fef8721363a2d3860f337ad53Marc Dietrich 826162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrichstatic struct platform_driver nvec_device_driver = { 827162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .probe = tegra_nvec_probe, 828162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .remove = __devexit_p(tegra_nvec_remove), 82932890b983086136fef8721363a2d3860f337ad53Marc Dietrich .suspend = tegra_nvec_suspend, 830162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .resume = tegra_nvec_resume, 831162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich .driver = { 83232890b983086136fef8721363a2d3860f337ad53Marc Dietrich .name = "nvec", 83332890b983086136fef8721363a2d3860f337ad53Marc Dietrich .owner = THIS_MODULE, 83432890b983086136fef8721363a2d3860f337ad53Marc Dietrich } 83532890b983086136fef8721363a2d3860f337ad53Marc Dietrich}; 83632890b983086136fef8721363a2d3860f337ad53Marc Dietrich 83732890b983086136fef8721363a2d3860f337ad53Marc Dietrichstatic int __init tegra_nvec_init(void) 83832890b983086136fef8721363a2d3860f337ad53Marc Dietrich{ 83932890b983086136fef8721363a2d3860f337ad53Marc Dietrich return platform_driver_register(&nvec_device_driver); 84032890b983086136fef8721363a2d3860f337ad53Marc Dietrich} 84132890b983086136fef8721363a2d3860f337ad53Marc Dietrich 84232890b983086136fef8721363a2d3860f337ad53Marc Dietrichmodule_init(tegra_nvec_init); 843162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc Dietrich 84432890b983086136fef8721363a2d3860f337ad53Marc DietrichMODULE_ALIAS("platform:nvec"); 845162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc DietrichMODULE_DESCRIPTION("NVIDIA compliant embedded controller interface"); 846162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc DietrichMODULE_AUTHOR("Marc Dietrich <marvin24@gmx.de>"); 847162c7d8c4be2d599583c42c2a8fe99bed6d87f67Marc DietrichMODULE_LICENSE("GPL"); 848