1162c7d8cSMarc Dietrich /* 2162c7d8cSMarc Dietrich * NVEC: NVIDIA compliant embedded controller interface 3162c7d8cSMarc Dietrich * 4162c7d8cSMarc Dietrich * Copyright (C) 2011 The AC100 Kernel Team <ac100@lists.lauchpad.net> 5162c7d8cSMarc Dietrich * 6162c7d8cSMarc Dietrich * Authors: Pierre-Hugues Husson <phhusson@free.fr> 7162c7d8cSMarc Dietrich * Ilya Petrov <ilya.muromec@gmail.com> 8162c7d8cSMarc Dietrich * Marc Dietrich <marvin24@gmx.de> 9791c4a64SJulian Andres Klode * Julian Andres Klode <jak@jak-linux.org> 10162c7d8cSMarc Dietrich * 11162c7d8cSMarc Dietrich * This file is subject to the terms and conditions of the GNU General Public 12162c7d8cSMarc Dietrich * License. See the file "COPYING" in the main directory of this archive 13162c7d8cSMarc Dietrich * for more details. 14162c7d8cSMarc Dietrich * 1532890b98SMarc Dietrich */ 1632890b98SMarc Dietrich 17162c7d8cSMarc Dietrich /* #define DEBUG */ 18162c7d8cSMarc Dietrich 1912b5a55dSJulian Andres Klode #include <linux/kernel.h> 203b769eddSMarc Dietrich #include <linux/module.h> 210b1076c4SJulian Andres Klode #include <linux/atomic.h> 2212b5a55dSJulian Andres Klode #include <linux/clk.h> 2332890b98SMarc Dietrich #include <linux/completion.h> 2412b5a55dSJulian Andres Klode #include <linux/delay.h> 2512b5a55dSJulian Andres Klode #include <linux/err.h> 2612b5a55dSJulian Andres Klode #include <linux/gpio.h> 2732890b98SMarc Dietrich #include <linux/interrupt.h> 28162c7d8cSMarc Dietrich #include <linux/io.h> 2932890b98SMarc Dietrich #include <linux/irq.h> 3032890b98SMarc Dietrich #include <linux/list.h> 3112b5a55dSJulian Andres Klode #include <linux/mfd/core.h> 3212b5a55dSJulian Andres Klode #include <linux/mutex.h> 3332890b98SMarc Dietrich #include <linux/notifier.h> 3432890b98SMarc Dietrich #include <linux/platform_device.h> 3512b5a55dSJulian Andres Klode #include <linux/slab.h> 3612b5a55dSJulian Andres Klode #include <linux/spinlock.h> 3712b5a55dSJulian Andres Klode #include <linux/workqueue.h> 38162c7d8cSMarc Dietrich 39162c7d8cSMarc Dietrich #include <mach/clk.h> 4012b5a55dSJulian Andres Klode #include <mach/iomap.h> 41162c7d8cSMarc Dietrich 4232890b98SMarc Dietrich #include "nvec.h" 4332890b98SMarc Dietrich 44391d2fa9SJulian Andres Klode #define I2C_CNFG 0x00 45391d2fa9SJulian Andres Klode #define I2C_CNFG_PACKET_MODE_EN (1<<10) 46391d2fa9SJulian Andres Klode #define I2C_CNFG_NEW_MASTER_SFM (1<<11) 47391d2fa9SJulian Andres Klode #define I2C_CNFG_DEBOUNCE_CNT_SHIFT 12 48391d2fa9SJulian Andres Klode 49391d2fa9SJulian Andres Klode #define I2C_SL_CNFG 0x20 50391d2fa9SJulian Andres Klode #define I2C_SL_NEWL (1<<2) 51391d2fa9SJulian Andres Klode #define I2C_SL_NACK (1<<1) 52391d2fa9SJulian Andres Klode #define I2C_SL_RESP (1<<0) 53391d2fa9SJulian Andres Klode #define I2C_SL_IRQ (1<<3) 54391d2fa9SJulian Andres Klode #define END_TRANS (1<<4) 55391d2fa9SJulian Andres Klode #define RCVD (1<<2) 56391d2fa9SJulian Andres Klode #define RNW (1<<1) 57391d2fa9SJulian Andres Klode 58391d2fa9SJulian Andres Klode #define I2C_SL_RCVD 0x24 59391d2fa9SJulian Andres Klode #define I2C_SL_STATUS 0x28 60391d2fa9SJulian Andres Klode #define I2C_SL_ADDR1 0x2c 61391d2fa9SJulian Andres Klode #define I2C_SL_ADDR2 0x30 62391d2fa9SJulian Andres Klode #define I2C_SL_DELAY_COUNT 0x3c 63391d2fa9SJulian Andres Klode 64bb0590e2SJulian Andres Klode /** 65bb0590e2SJulian Andres Klode * enum nvec_msg_category - Message categories for nvec_msg_alloc() 66bb0590e2SJulian Andres Klode * @NVEC_MSG_RX: The message is an incoming message (from EC) 67bb0590e2SJulian Andres Klode * @NVEC_MSG_TX: The message is an outgoing message (to EC) 68bb0590e2SJulian Andres Klode */ 69bb0590e2SJulian Andres Klode enum nvec_msg_category { 70bb0590e2SJulian Andres Klode NVEC_MSG_RX, 71bb0590e2SJulian Andres Klode NVEC_MSG_TX, 72bb0590e2SJulian Andres Klode }; 73bb0590e2SJulian Andres Klode 74162c7d8cSMarc Dietrich static const unsigned char EC_DISABLE_EVENT_REPORTING[3] = "\x04\x00\x00"; 75162c7d8cSMarc Dietrich static const unsigned char EC_ENABLE_EVENT_REPORTING[3] = "\x04\x00\x01"; 76162c7d8cSMarc Dietrich static const unsigned char EC_GET_FIRMWARE_VERSION[2] = "\x07\x15"; 7732890b98SMarc Dietrich 7832890b98SMarc Dietrich static struct nvec_chip *nvec_power_handle; 7932890b98SMarc Dietrich 80f686e9afSMarc Dietrich static struct mfd_cell nvec_devices[] = { 81f686e9afSMarc Dietrich { 82f686e9afSMarc Dietrich .name = "nvec-kbd", 83f686e9afSMarc Dietrich .id = 1, 84f686e9afSMarc Dietrich }, 85f686e9afSMarc Dietrich { 86f686e9afSMarc Dietrich .name = "nvec-mouse", 87f686e9afSMarc Dietrich .id = 1, 88f686e9afSMarc Dietrich }, 89f686e9afSMarc Dietrich { 90f686e9afSMarc Dietrich .name = "nvec-power", 91f686e9afSMarc Dietrich .id = 1, 92f686e9afSMarc Dietrich }, 93f686e9afSMarc Dietrich { 94f686e9afSMarc Dietrich .name = "nvec-power", 95f686e9afSMarc Dietrich .id = 2, 96f686e9afSMarc Dietrich }, 9797cc2657SIlya Petrov { 9897cc2657SIlya Petrov .name = "nvec-leds", 9997cc2657SIlya Petrov .id = 1, 10097cc2657SIlya Petrov }, 101f686e9afSMarc Dietrich }; 102f686e9afSMarc Dietrich 103bdf034d9SJulian Andres Klode /** 104bdf034d9SJulian Andres Klode * nvec_register_notifier - Register a notifier with nvec 105bdf034d9SJulian Andres Klode * @nvec: A &struct nvec_chip 106bdf034d9SJulian Andres Klode * @nb: The notifier block to register 107bdf034d9SJulian Andres Klode * 108bdf034d9SJulian Andres Klode * Registers a notifier with @nvec. The notifier will be added to an atomic 109bdf034d9SJulian Andres Klode * notifier chain that is called for all received messages except those that 110bdf034d9SJulian Andres Klode * correspond to a request initiated by nvec_write_sync(). 111bdf034d9SJulian Andres Klode */ 11232890b98SMarc Dietrich int nvec_register_notifier(struct nvec_chip *nvec, struct notifier_block *nb, 11332890b98SMarc Dietrich unsigned int events) 11432890b98SMarc Dietrich { 11532890b98SMarc Dietrich return atomic_notifier_chain_register(&nvec->notifier_list, nb); 11632890b98SMarc Dietrich } 11732890b98SMarc Dietrich EXPORT_SYMBOL_GPL(nvec_register_notifier); 11832890b98SMarc Dietrich 119bdf034d9SJulian Andres Klode /** 120bdf034d9SJulian Andres Klode * nvec_status_notifier - The final notifier 121bdf034d9SJulian Andres Klode * 122bdf034d9SJulian Andres Klode * Prints a message about control events not handled in the notifier 123bdf034d9SJulian Andres Klode * chain. 124bdf034d9SJulian Andres Klode */ 125162c7d8cSMarc Dietrich static int nvec_status_notifier(struct notifier_block *nb, 126162c7d8cSMarc Dietrich unsigned long event_type, void *data) 12732890b98SMarc Dietrich { 12832890b98SMarc Dietrich unsigned char *msg = (unsigned char *)data; 12932890b98SMarc Dietrich 13032890b98SMarc Dietrich if (event_type != NVEC_CNTL) 13132890b98SMarc Dietrich return NOTIFY_DONE; 13232890b98SMarc Dietrich 133a3a9aa1aSMarc Dietrich printk(KERN_WARNING "unhandled msg type %ld\n", event_type); 134a3a9aa1aSMarc Dietrich print_hex_dump(KERN_WARNING, "payload: ", DUMP_PREFIX_NONE, 16, 1, 135a3a9aa1aSMarc Dietrich msg, msg[1] + 2, true); 13632890b98SMarc Dietrich 13732890b98SMarc Dietrich return NOTIFY_OK; 13832890b98SMarc Dietrich } 13932890b98SMarc Dietrich 140bdf034d9SJulian Andres Klode /** 141bdf034d9SJulian Andres Klode * nvec_msg_alloc: 142bdf034d9SJulian Andres Klode * @nvec: A &struct nvec_chip 143bb0590e2SJulian Andres Klode * @category: Pool category, see &enum nvec_msg_category 144bdf034d9SJulian Andres Klode * 145bdf034d9SJulian Andres Klode * Allocate a single &struct nvec_msg object from the message pool of 146bdf034d9SJulian Andres Klode * @nvec. The result shall be passed to nvec_msg_free() if no longer 147bdf034d9SJulian Andres Klode * used. 148bb0590e2SJulian Andres Klode * 149bb0590e2SJulian Andres Klode * Outgoing messages are placed in the upper 75% of the pool, keeping the 150bb0590e2SJulian Andres Klode * lower 25% available for RX buffers only. The reason is to prevent a 151bb0590e2SJulian Andres Klode * situation where all buffers are full and a message is thus endlessly 152bb0590e2SJulian Andres Klode * retried because the response could never be processed. 153bdf034d9SJulian Andres Klode */ 154bb0590e2SJulian Andres Klode static struct nvec_msg *nvec_msg_alloc(struct nvec_chip *nvec, 155bb0590e2SJulian Andres Klode enum nvec_msg_category category) 1560b1076c4SJulian Andres Klode { 157bb0590e2SJulian Andres Klode int i = (category == NVEC_MSG_TX) ? (NVEC_POOL_SIZE / 4) : 0; 1580b1076c4SJulian Andres Klode 159bb0590e2SJulian Andres Klode for (; i < NVEC_POOL_SIZE; i++) { 1600b1076c4SJulian Andres Klode if (atomic_xchg(&nvec->msg_pool[i].used, 1) == 0) { 1610b1076c4SJulian Andres Klode dev_vdbg(nvec->dev, "INFO: Allocate %i\n", i); 1620b1076c4SJulian Andres Klode return &nvec->msg_pool[i]; 1630b1076c4SJulian Andres Klode } 1640b1076c4SJulian Andres Klode } 1650b1076c4SJulian Andres Klode 166bb0590e2SJulian Andres Klode dev_err(nvec->dev, "could not allocate %s buffer\n", 167bb0590e2SJulian Andres Klode (category == NVEC_MSG_TX) ? "TX" : "RX"); 1680b1076c4SJulian Andres Klode 1690b1076c4SJulian Andres Klode return NULL; 1700b1076c4SJulian Andres Klode } 1710b1076c4SJulian Andres Klode 172bdf034d9SJulian Andres Klode /** 173bdf034d9SJulian Andres Klode * nvec_msg_free: 174bdf034d9SJulian Andres Klode * @nvec: A &struct nvec_chip 175bdf034d9SJulian Andres Klode * @msg: A message (must be allocated by nvec_msg_alloc() and belong to @nvec) 176bdf034d9SJulian Andres Klode * 177bdf034d9SJulian Andres Klode * Free the given message 178bdf034d9SJulian Andres Klode */ 179198dd267SJulian Andres Klode inline void nvec_msg_free(struct nvec_chip *nvec, struct nvec_msg *msg) 1800b1076c4SJulian Andres Klode { 1817b770657SJulian Andres Klode if (msg != &nvec->tx_scratch) 1820b1076c4SJulian Andres Klode dev_vdbg(nvec->dev, "INFO: Free %ti\n", msg - nvec->msg_pool); 1830b1076c4SJulian Andres Klode atomic_set(&msg->used, 0); 1840b1076c4SJulian Andres Klode } 185198dd267SJulian Andres Klode EXPORT_SYMBOL_GPL(nvec_msg_free); 1860b1076c4SJulian Andres Klode 1878517e879SJulian Andres Klode /** 1888517e879SJulian Andres Klode * nvec_msg_is_event - Return %true if @msg is an event 1898517e879SJulian Andres Klode * @msg: A message 1908517e879SJulian Andres Klode */ 1918517e879SJulian Andres Klode static bool nvec_msg_is_event(struct nvec_msg *msg) 1928517e879SJulian Andres Klode { 1938517e879SJulian Andres Klode return msg->data[0] >> 7; 1948517e879SJulian Andres Klode } 1958517e879SJulian Andres Klode 1968517e879SJulian Andres Klode /** 1978517e879SJulian Andres Klode * nvec_msg_size - Get the size of a message 1988517e879SJulian Andres Klode * @msg: The message to get the size for 1998517e879SJulian Andres Klode * 2008517e879SJulian Andres Klode * This only works for received messages, not for outgoing messages. 2018517e879SJulian Andres Klode */ 2028517e879SJulian Andres Klode static size_t nvec_msg_size(struct nvec_msg *msg) 2038517e879SJulian Andres Klode { 2048517e879SJulian Andres Klode bool is_event = nvec_msg_is_event(msg); 2058517e879SJulian Andres Klode int event_length = (msg->data[0] & 0x60) >> 5; 2068517e879SJulian Andres Klode 2078517e879SJulian Andres Klode /* for variable size, payload size in byte 1 + count (1) + cmd (1) */ 2088517e879SJulian Andres Klode if (!is_event || event_length == NVEC_VAR_SIZE) 2098517e879SJulian Andres Klode return (msg->pos || msg->size) ? (msg->data[1] + 2) : 0; 2108517e879SJulian Andres Klode else if (event_length == NVEC_2BYTES) 2118517e879SJulian Andres Klode return 2; 2128517e879SJulian Andres Klode else if (event_length == NVEC_3BYTES) 2138517e879SJulian Andres Klode return 3; 2148517e879SJulian Andres Klode else 2158517e879SJulian Andres Klode return 0; 2168517e879SJulian Andres Klode } 2178517e879SJulian Andres Klode 218bdf034d9SJulian Andres Klode /** 219bdf034d9SJulian Andres Klode * nvec_gpio_set_value - Set the GPIO value 220bdf034d9SJulian Andres Klode * @nvec: A &struct nvec_chip 221bdf034d9SJulian Andres Klode * @value: The value to write (0 or 1) 222bdf034d9SJulian Andres Klode * 223bdf034d9SJulian Andres Klode * Like gpio_set_value(), but generating debugging information 224bdf034d9SJulian Andres Klode */ 225e7c40851SJulian Andres Klode static void nvec_gpio_set_value(struct nvec_chip *nvec, int value) 226e7c40851SJulian Andres Klode { 227e7c40851SJulian Andres Klode dev_dbg(nvec->dev, "GPIO changed from %u to %u\n", 228e7c40851SJulian Andres Klode gpio_get_value(nvec->gpio), value); 229e7c40851SJulian Andres Klode gpio_set_value(nvec->gpio, value); 230e7c40851SJulian Andres Klode } 231e7c40851SJulian Andres Klode 232bdf034d9SJulian Andres Klode /** 233bdf034d9SJulian Andres Klode * nvec_write_async - Asynchronously write a message to NVEC 234bdf034d9SJulian Andres Klode * @nvec: An nvec_chip instance 235bdf034d9SJulian Andres Klode * @data: The message data, starting with the request type 236bdf034d9SJulian Andres Klode * @size: The size of @data 237bdf034d9SJulian Andres Klode * 238bdf034d9SJulian Andres Klode * Queue a single message to be transferred to the embedded controller 239bdf034d9SJulian Andres Klode * and return immediately. 240bdf034d9SJulian Andres Klode * 241bdf034d9SJulian Andres Klode * Returns: 0 on success, a negative error code on failure. If a failure 242bdf034d9SJulian Andres Klode * occured, the nvec driver may print an error. 243bdf034d9SJulian Andres Klode */ 2441b9bf629SJulian Andres Klode int nvec_write_async(struct nvec_chip *nvec, const unsigned char *data, 245162c7d8cSMarc Dietrich short size) 24632890b98SMarc Dietrich { 2470cab4cb8SJulian Andres Klode struct nvec_msg *msg; 2480cab4cb8SJulian Andres Klode unsigned long flags; 24932890b98SMarc Dietrich 250bb0590e2SJulian Andres Klode msg = nvec_msg_alloc(nvec, NVEC_MSG_TX); 251bb0590e2SJulian Andres Klode 2521b9bf629SJulian Andres Klode if (msg == NULL) 2531b9bf629SJulian Andres Klode return -ENOMEM; 2541b9bf629SJulian Andres Klode 25532890b98SMarc Dietrich msg->data[0] = size; 25632890b98SMarc Dietrich memcpy(msg->data + 1, data, size); 25732890b98SMarc Dietrich msg->size = size + 1; 25832890b98SMarc Dietrich 2590cab4cb8SJulian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 26032890b98SMarc Dietrich list_add_tail(&msg->node, &nvec->tx_data); 2610cab4cb8SJulian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 26232890b98SMarc Dietrich 2630cab4cb8SJulian Andres Klode queue_work(nvec->wq, &nvec->tx_work); 2641b9bf629SJulian Andres Klode 2651b9bf629SJulian Andres Klode return 0; 26632890b98SMarc Dietrich } 26732890b98SMarc Dietrich EXPORT_SYMBOL(nvec_write_async); 26832890b98SMarc Dietrich 269bdf034d9SJulian Andres Klode /** 270bdf034d9SJulian Andres Klode * nvec_write_sync - Write a message to nvec and read the response 271bdf034d9SJulian Andres Klode * @nvec: An &struct nvec_chip 272bdf034d9SJulian Andres Klode * @data: The data to write 273bdf034d9SJulian Andres Klode * @size: The size of @data 274bdf034d9SJulian Andres Klode * 275bdf034d9SJulian Andres Klode * This is similar to nvec_write_async(), but waits for the 276bdf034d9SJulian Andres Klode * request to be answered before returning. This function 277bdf034d9SJulian Andres Klode * uses a mutex and can thus not be called from e.g. 278bdf034d9SJulian Andres Klode * interrupt handlers. 279bdf034d9SJulian Andres Klode * 280bdf034d9SJulian Andres Klode * Returns: A pointer to the response message on success, 281198dd267SJulian Andres Klode * %NULL on failure. Free with nvec_msg_free() once no longer 282198dd267SJulian Andres Klode * used. 283bdf034d9SJulian Andres Klode */ 2840cab4cb8SJulian Andres Klode struct nvec_msg *nvec_write_sync(struct nvec_chip *nvec, 2850cab4cb8SJulian Andres Klode const unsigned char *data, short size) 2860cab4cb8SJulian Andres Klode { 2870cab4cb8SJulian Andres Klode struct nvec_msg *msg; 2880cab4cb8SJulian Andres Klode 2890cab4cb8SJulian Andres Klode mutex_lock(&nvec->sync_write_mutex); 2900cab4cb8SJulian Andres Klode 2910cab4cb8SJulian Andres Klode nvec->sync_write_pending = (data[1] << 8) + data[0]; 2921b9bf629SJulian Andres Klode 2931b9bf629SJulian Andres Klode if (nvec_write_async(nvec, data, size) < 0) 2941b9bf629SJulian Andres Klode return NULL; 2950cab4cb8SJulian Andres Klode 2960cab4cb8SJulian Andres Klode dev_dbg(nvec->dev, "nvec_sync_write: 0x%04x\n", 2970cab4cb8SJulian Andres Klode nvec->sync_write_pending); 2980cab4cb8SJulian Andres Klode if (!(wait_for_completion_timeout(&nvec->sync_write, 2990cab4cb8SJulian Andres Klode msecs_to_jiffies(2000)))) { 3000cab4cb8SJulian Andres Klode dev_warn(nvec->dev, "timeout waiting for sync write to complete\n"); 3010cab4cb8SJulian Andres Klode mutex_unlock(&nvec->sync_write_mutex); 3020cab4cb8SJulian Andres Klode return NULL; 3030cab4cb8SJulian Andres Klode } 3040cab4cb8SJulian Andres Klode 3050cab4cb8SJulian Andres Klode dev_dbg(nvec->dev, "nvec_sync_write: pong!\n"); 3060cab4cb8SJulian Andres Klode 3070cab4cb8SJulian Andres Klode msg = nvec->last_sync_msg; 3080cab4cb8SJulian Andres Klode 3090cab4cb8SJulian Andres Klode mutex_unlock(&nvec->sync_write_mutex); 3100cab4cb8SJulian Andres Klode 3110cab4cb8SJulian Andres Klode return msg; 3120cab4cb8SJulian Andres Klode } 3130cab4cb8SJulian Andres Klode EXPORT_SYMBOL(nvec_write_sync); 3140cab4cb8SJulian Andres Klode 315bdf034d9SJulian Andres Klode /** 316bdf034d9SJulian Andres Klode * nvec_request_master - Process outgoing messages 317bdf034d9SJulian Andres Klode * @work: A &struct work_struct (the tx_worker member of &struct nvec_chip) 318bdf034d9SJulian Andres Klode * 319bdf034d9SJulian Andres Klode * Processes all outgoing requests by sending the request and awaiting the 320bdf034d9SJulian Andres Klode * response, then continuing with the next request. Once a request has a 321bdf034d9SJulian Andres Klode * matching response, it will be freed and removed from the list. 322bdf034d9SJulian Andres Klode */ 32332890b98SMarc Dietrich static void nvec_request_master(struct work_struct *work) 32432890b98SMarc Dietrich { 32532890b98SMarc Dietrich struct nvec_chip *nvec = container_of(work, struct nvec_chip, tx_work); 3260cab4cb8SJulian Andres Klode unsigned long flags; 3270cab4cb8SJulian Andres Klode long err; 3280cab4cb8SJulian Andres Klode struct nvec_msg *msg; 32932890b98SMarc Dietrich 3300cab4cb8SJulian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 3310cab4cb8SJulian Andres Klode while (!list_empty(&nvec->tx_data)) { 3320cab4cb8SJulian Andres Klode msg = list_first_entry(&nvec->tx_data, struct nvec_msg, node); 3330cab4cb8SJulian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 3340cab4cb8SJulian Andres Klode nvec_gpio_set_value(nvec, 0); 3350cab4cb8SJulian Andres Klode err = wait_for_completion_interruptible_timeout( 3360cab4cb8SJulian Andres Klode &nvec->ec_transfer, msecs_to_jiffies(5000)); 3370cab4cb8SJulian Andres Klode 3380cab4cb8SJulian Andres Klode if (err == 0) { 3390cab4cb8SJulian Andres Klode dev_warn(nvec->dev, "timeout waiting for ec transfer\n"); 3400cab4cb8SJulian Andres Klode nvec_gpio_set_value(nvec, 1); 3410cab4cb8SJulian Andres Klode msg->pos = 0; 3420cab4cb8SJulian Andres Klode } 3430cab4cb8SJulian Andres Klode 3440cab4cb8SJulian Andres Klode spin_lock_irqsave(&nvec->tx_lock, flags); 3450cab4cb8SJulian Andres Klode 3460cab4cb8SJulian Andres Klode if (err > 0) { 3470cab4cb8SJulian Andres Klode list_del_init(&msg->node); 3480cab4cb8SJulian Andres Klode nvec_msg_free(nvec, msg); 3490cab4cb8SJulian Andres Klode } 3500cab4cb8SJulian Andres Klode } 3510cab4cb8SJulian Andres Klode spin_unlock_irqrestore(&nvec->tx_lock, flags); 35232890b98SMarc Dietrich } 35332890b98SMarc Dietrich 354bdf034d9SJulian Andres Klode /** 355bdf034d9SJulian Andres Klode * parse_msg - Print some information and call the notifiers on an RX message 356bdf034d9SJulian Andres Klode * @nvec: A &struct nvec_chip 357bdf034d9SJulian Andres Klode * @msg: A message received by @nvec 358bdf034d9SJulian Andres Klode * 359bdf034d9SJulian Andres Klode * Paarse some pieces of the message and then call the chain of notifiers 360bdf034d9SJulian Andres Klode * registered via nvec_register_notifier. 361bdf034d9SJulian Andres Klode */ 36232890b98SMarc Dietrich static int parse_msg(struct nvec_chip *nvec, struct nvec_msg *msg) 36332890b98SMarc Dietrich { 36432890b98SMarc Dietrich if ((msg->data[0] & 1 << 7) == 0 && msg->data[3]) { 365162c7d8cSMarc Dietrich dev_err(nvec->dev, "ec responded %02x %02x %02x %02x\n", 366162c7d8cSMarc Dietrich msg->data[0], msg->data[1], msg->data[2], msg->data[3]); 36732890b98SMarc Dietrich return -EINVAL; 36832890b98SMarc Dietrich } 36932890b98SMarc Dietrich 370a3a9aa1aSMarc Dietrich if ((msg->data[0] >> 7) == 1 && (msg->data[0] & 0x0f) == 5) 371a3a9aa1aSMarc Dietrich print_hex_dump(KERN_WARNING, "ec system event ", 372a3a9aa1aSMarc Dietrich DUMP_PREFIX_NONE, 16, 1, msg->data, 373a3a9aa1aSMarc Dietrich msg->data[1] + 2, true); 37432890b98SMarc Dietrich 375162c7d8cSMarc Dietrich atomic_notifier_call_chain(&nvec->notifier_list, msg->data[0] & 0x8f, 376162c7d8cSMarc Dietrich msg->data); 37732890b98SMarc Dietrich 37832890b98SMarc Dietrich return 0; 37932890b98SMarc Dietrich } 38032890b98SMarc Dietrich 381bdf034d9SJulian Andres Klode /** 382bdf034d9SJulian Andres Klode * nvec_dispatch - Process messages received from the EC 383bdf034d9SJulian Andres Klode * @work: A &struct work_struct (the tx_worker member of &struct nvec_chip) 384bdf034d9SJulian Andres Klode * 385bdf034d9SJulian Andres Klode * Process messages previously received from the EC and put into the RX 386bdf034d9SJulian Andres Klode * queue of the &struct nvec_chip instance associated with @work. 387bdf034d9SJulian Andres Klode */ 38832890b98SMarc Dietrich static void nvec_dispatch(struct work_struct *work) 38932890b98SMarc Dietrich { 39032890b98SMarc Dietrich struct nvec_chip *nvec = container_of(work, struct nvec_chip, rx_work); 3910cab4cb8SJulian Andres Klode unsigned long flags; 39232890b98SMarc Dietrich struct nvec_msg *msg; 39332890b98SMarc Dietrich 3940cab4cb8SJulian Andres Klode spin_lock_irqsave(&nvec->rx_lock, flags); 395162c7d8cSMarc Dietrich while (!list_empty(&nvec->rx_data)) { 39632890b98SMarc Dietrich msg = list_first_entry(&nvec->rx_data, struct nvec_msg, node); 39732890b98SMarc Dietrich list_del_init(&msg->node); 3980cab4cb8SJulian Andres Klode spin_unlock_irqrestore(&nvec->rx_lock, flags); 39932890b98SMarc Dietrich 400162c7d8cSMarc Dietrich if (nvec->sync_write_pending == 401162c7d8cSMarc Dietrich (msg->data[2] << 8) + msg->data[0]) { 40232890b98SMarc Dietrich dev_dbg(nvec->dev, "sync write completed!\n"); 40332890b98SMarc Dietrich nvec->sync_write_pending = 0; 40432890b98SMarc Dietrich nvec->last_sync_msg = msg; 40532890b98SMarc Dietrich complete(&nvec->sync_write); 40632890b98SMarc Dietrich } else { 40732890b98SMarc Dietrich parse_msg(nvec, msg); 4080cab4cb8SJulian Andres Klode nvec_msg_free(nvec, msg); 40932890b98SMarc Dietrich } 4100cab4cb8SJulian Andres Klode spin_lock_irqsave(&nvec->rx_lock, flags); 41132890b98SMarc Dietrich } 4120cab4cb8SJulian Andres Klode spin_unlock_irqrestore(&nvec->rx_lock, flags); 4130cab4cb8SJulian Andres Klode } 4140cab4cb8SJulian Andres Klode 415bdf034d9SJulian Andres Klode /** 416bdf034d9SJulian Andres Klode * nvec_tx_completed - Complete the current transfer 417bdf034d9SJulian Andres Klode * @nvec: A &struct nvec_chip 418bdf034d9SJulian Andres Klode * 419bdf034d9SJulian Andres Klode * This is called when we have received an END_TRANS on a TX transfer. 420bdf034d9SJulian Andres Klode */ 4210cab4cb8SJulian Andres Klode static void nvec_tx_completed(struct nvec_chip *nvec) 4220cab4cb8SJulian Andres Klode { 4230cab4cb8SJulian Andres Klode /* We got an END_TRANS, let's skip this, maybe there's an event */ 4240cab4cb8SJulian Andres Klode if (nvec->tx->pos != nvec->tx->size) { 4250cab4cb8SJulian Andres Klode dev_err(nvec->dev, "premature END_TRANS, resending\n"); 4260cab4cb8SJulian Andres Klode nvec->tx->pos = 0; 4270cab4cb8SJulian Andres Klode nvec_gpio_set_value(nvec, 0); 4280cab4cb8SJulian Andres Klode } else { 4290cab4cb8SJulian Andres Klode nvec->state = 0; 43032890b98SMarc Dietrich } 43132890b98SMarc Dietrich } 43232890b98SMarc Dietrich 433bdf034d9SJulian Andres Klode /** 434bdf034d9SJulian Andres Klode * nvec_rx_completed - Complete the current transfer 435bdf034d9SJulian Andres Klode * @nvec: A &struct nvec_chip 436bdf034d9SJulian Andres Klode * 437bdf034d9SJulian Andres Klode * This is called when we have received an END_TRANS on a RX transfer. 438bdf034d9SJulian Andres Klode */ 4390cab4cb8SJulian Andres Klode static void nvec_rx_completed(struct nvec_chip *nvec) 4400cab4cb8SJulian Andres Klode { 441210ceb4fSJulian Andres Klode if (nvec->rx->pos != nvec_msg_size(nvec->rx)) { 4420cab4cb8SJulian Andres Klode dev_err(nvec->dev, "RX incomplete: Expected %u bytes, got %u\n", 4430cab4cb8SJulian Andres Klode (uint) nvec_msg_size(nvec->rx), 4440cab4cb8SJulian Andres Klode (uint) nvec->rx->pos); 4450cab4cb8SJulian Andres Klode 446210ceb4fSJulian Andres Klode nvec_msg_free(nvec, nvec->rx); 447210ceb4fSJulian Andres Klode nvec->state = 0; 448d6bdcf2eSJulian Andres Klode 449d6bdcf2eSJulian Andres Klode /* Battery quirk - Often incomplete, and likes to crash */ 450d6bdcf2eSJulian Andres Klode if (nvec->rx->data[0] == NVEC_BAT) 451d6bdcf2eSJulian Andres Klode complete(&nvec->ec_transfer); 452d6bdcf2eSJulian Andres Klode 453210ceb4fSJulian Andres Klode return; 454210ceb4fSJulian Andres Klode } 455210ceb4fSJulian Andres Klode 4560cab4cb8SJulian Andres Klode spin_lock(&nvec->rx_lock); 4570cab4cb8SJulian Andres Klode 4580cab4cb8SJulian Andres Klode /* add the received data to the work list 4590cab4cb8SJulian Andres Klode and move the ring buffer pointer to the next entry */ 4600cab4cb8SJulian Andres Klode list_add_tail(&nvec->rx->node, &nvec->rx_data); 4610cab4cb8SJulian Andres Klode 4620cab4cb8SJulian Andres Klode spin_unlock(&nvec->rx_lock); 4630cab4cb8SJulian Andres Klode 4640cab4cb8SJulian Andres Klode nvec->state = 0; 4650cab4cb8SJulian Andres Klode 4660cab4cb8SJulian Andres Klode if (!nvec_msg_is_event(nvec->rx)) 4670cab4cb8SJulian Andres Klode complete(&nvec->ec_transfer); 4680cab4cb8SJulian Andres Klode 4690cab4cb8SJulian Andres Klode queue_work(nvec->wq, &nvec->rx_work); 4700cab4cb8SJulian Andres Klode } 4710cab4cb8SJulian Andres Klode 4720cab4cb8SJulian Andres Klode /** 4730cab4cb8SJulian Andres Klode * nvec_invalid_flags - Send an error message about invalid flags and jump 4740cab4cb8SJulian Andres Klode * @nvec: The nvec device 4750cab4cb8SJulian Andres Klode * @status: The status flags 4760cab4cb8SJulian Andres Klode * @reset: Whether we shall jump to state 0. 4770cab4cb8SJulian Andres Klode */ 4780cab4cb8SJulian Andres Klode static void nvec_invalid_flags(struct nvec_chip *nvec, unsigned int status, 4790cab4cb8SJulian Andres Klode bool reset) 4800cab4cb8SJulian Andres Klode { 4810cab4cb8SJulian Andres Klode dev_err(nvec->dev, "unexpected status flags 0x%02x during state %i\n", 4820cab4cb8SJulian Andres Klode status, nvec->state); 4830cab4cb8SJulian Andres Klode if (reset) 4840cab4cb8SJulian Andres Klode nvec->state = 0; 4850cab4cb8SJulian Andres Klode } 4860cab4cb8SJulian Andres Klode 4870cab4cb8SJulian Andres Klode /** 4880cab4cb8SJulian Andres Klode * nvec_tx_set - Set the message to transfer (nvec->tx) 489bdf034d9SJulian Andres Klode * @nvec: A &struct nvec_chip 490bdf034d9SJulian Andres Klode * 491bdf034d9SJulian Andres Klode * Gets the first entry from the tx_data list of @nvec and sets the 492bdf034d9SJulian Andres Klode * tx member to it. If the tx_data list is empty, this uses the 493bdf034d9SJulian Andres Klode * tx_scratch message to send a no operation message. 4940cab4cb8SJulian Andres Klode */ 4950cab4cb8SJulian Andres Klode static void nvec_tx_set(struct nvec_chip *nvec) 4960cab4cb8SJulian Andres Klode { 4970cab4cb8SJulian Andres Klode spin_lock(&nvec->tx_lock); 4980cab4cb8SJulian Andres Klode if (list_empty(&nvec->tx_data)) { 4990cab4cb8SJulian Andres Klode dev_err(nvec->dev, "empty tx - sending no-op\n"); 5000cab4cb8SJulian Andres Klode memcpy(nvec->tx_scratch.data, "\x02\x07\x02", 3); 5010cab4cb8SJulian Andres Klode nvec->tx_scratch.size = 3; 5020cab4cb8SJulian Andres Klode nvec->tx_scratch.pos = 0; 5030cab4cb8SJulian Andres Klode nvec->tx = &nvec->tx_scratch; 5040cab4cb8SJulian Andres Klode list_add_tail(&nvec->tx->node, &nvec->tx_data); 5050cab4cb8SJulian Andres Klode } else { 5060cab4cb8SJulian Andres Klode nvec->tx = list_first_entry(&nvec->tx_data, struct nvec_msg, 5070cab4cb8SJulian Andres Klode node); 5080cab4cb8SJulian Andres Klode nvec->tx->pos = 0; 5090cab4cb8SJulian Andres Klode } 5100cab4cb8SJulian Andres Klode spin_unlock(&nvec->tx_lock); 5110cab4cb8SJulian Andres Klode 5120cab4cb8SJulian Andres Klode dev_dbg(nvec->dev, "Sending message of length %u, command 0x%x\n", 5130cab4cb8SJulian Andres Klode (uint)nvec->tx->size, nvec->tx->data[1]); 5140cab4cb8SJulian Andres Klode } 5150cab4cb8SJulian Andres Klode 5160cab4cb8SJulian Andres Klode /** 5170cab4cb8SJulian Andres Klode * nvec_interrupt - Interrupt handler 5180cab4cb8SJulian Andres Klode * @irq: The IRQ 5190cab4cb8SJulian Andres Klode * @dev: The nvec device 520bdf034d9SJulian Andres Klode * 521bdf034d9SJulian Andres Klode * Interrupt handler that fills our RX buffers and empties our TX 522bdf034d9SJulian Andres Klode * buffers. This uses a finite state machine with ridiculous amounts 523bdf034d9SJulian Andres Klode * of error checking, in order to be fairly reliable. 5240cab4cb8SJulian Andres Klode */ 525f686e9afSMarc Dietrich static irqreturn_t nvec_interrupt(int irq, void *dev) 52632890b98SMarc Dietrich { 52732890b98SMarc Dietrich unsigned long status; 5280cab4cb8SJulian Andres Klode unsigned int received = 0; 5290cab4cb8SJulian Andres Klode unsigned char to_send = 0xff; 5300cab4cb8SJulian Andres Klode const unsigned long irq_mask = I2C_SL_IRQ | END_TRANS | RCVD | RNW; 5310cab4cb8SJulian Andres Klode struct nvec_chip *nvec = dev; 5320cab4cb8SJulian Andres Klode unsigned int state = nvec->state; 53332890b98SMarc Dietrich 5340cab4cb8SJulian Andres Klode status = readl(nvec->base + I2C_SL_STATUS); 53532890b98SMarc Dietrich 5360cab4cb8SJulian Andres Klode /* Filter out some errors */ 5370cab4cb8SJulian Andres Klode if ((status & irq_mask) == 0 && (status & ~irq_mask) != 0) { 5380cab4cb8SJulian Andres Klode dev_err(nvec->dev, "unexpected irq mask %lx\n", status); 53932890b98SMarc Dietrich return IRQ_HANDLED; 5400cab4cb8SJulian Andres Klode } 5410cab4cb8SJulian Andres Klode if ((status & I2C_SL_IRQ) == 0) { 5420cab4cb8SJulian Andres Klode dev_err(nvec->dev, "Spurious IRQ\n"); 5430cab4cb8SJulian Andres Klode return IRQ_HANDLED; 5440cab4cb8SJulian Andres Klode } 5450cab4cb8SJulian Andres Klode 5460cab4cb8SJulian Andres Klode /* The EC did not request a read, so it send us something, read it */ 5470cab4cb8SJulian Andres Klode if ((status & RNW) == 0) { 5480cab4cb8SJulian Andres Klode received = readl(nvec->base + I2C_SL_RCVD); 54932890b98SMarc Dietrich if (status & RCVD) 5500cab4cb8SJulian Andres Klode writel(0, nvec->base + I2C_SL_RCVD); 5510cab4cb8SJulian Andres Klode } 55232890b98SMarc Dietrich 5530cab4cb8SJulian Andres Klode if (status == (I2C_SL_IRQ | RCVD)) 5540cab4cb8SJulian Andres Klode nvec->state = 0; 555162c7d8cSMarc Dietrich 5560cab4cb8SJulian Andres Klode switch (nvec->state) { 5570cab4cb8SJulian Andres Klode case 0: /* Verify that its a transfer start, the rest later */ 5580cab4cb8SJulian Andres Klode if (status != (I2C_SL_IRQ | RCVD)) 5590cab4cb8SJulian Andres Klode nvec_invalid_flags(nvec, status, false); 5600cab4cb8SJulian Andres Klode break; 5610cab4cb8SJulian Andres Klode case 1: /* command byte */ 5620cab4cb8SJulian Andres Klode if (status != I2C_SL_IRQ) { 5630cab4cb8SJulian Andres Klode nvec_invalid_flags(nvec, status, true); 56432890b98SMarc Dietrich } else { 565bb0590e2SJulian Andres Klode nvec->rx = nvec_msg_alloc(nvec, NVEC_MSG_RX); 5668da79863SJulian Andres Klode /* Should not happen in a normal world */ 5678da79863SJulian Andres Klode if (unlikely(nvec->rx == NULL)) { 5688da79863SJulian Andres Klode nvec->state = 0; 5698da79863SJulian Andres Klode break; 5708da79863SJulian Andres Klode } 5710cab4cb8SJulian Andres Klode nvec->rx->data[0] = received; 5720cab4cb8SJulian Andres Klode nvec->rx->pos = 1; 5730cab4cb8SJulian Andres Klode nvec->state = 2; 5740cab4cb8SJulian Andres Klode } 5750cab4cb8SJulian Andres Klode break; 5760cab4cb8SJulian Andres Klode case 2: /* first byte after command */ 5770cab4cb8SJulian Andres Klode if (status == (I2C_SL_IRQ | RNW | RCVD)) { 5780cab4cb8SJulian Andres Klode udelay(33); 5790cab4cb8SJulian Andres Klode if (nvec->rx->data[0] != 0x01) { 5800cab4cb8SJulian Andres Klode dev_err(nvec->dev, 5810cab4cb8SJulian Andres Klode "Read without prior read command\n"); 5820cab4cb8SJulian Andres Klode nvec->state = 0; 5830cab4cb8SJulian Andres Klode break; 5840cab4cb8SJulian Andres Klode } 5850cab4cb8SJulian Andres Klode nvec_msg_free(nvec, nvec->rx); 5860cab4cb8SJulian Andres Klode nvec->state = 3; 5870cab4cb8SJulian Andres Klode nvec_tx_set(nvec); 5880cab4cb8SJulian Andres Klode BUG_ON(nvec->tx->size < 1); 5890cab4cb8SJulian Andres Klode to_send = nvec->tx->data[0]; 5900cab4cb8SJulian Andres Klode nvec->tx->pos = 1; 5910cab4cb8SJulian Andres Klode } else if (status == (I2C_SL_IRQ)) { 5920cab4cb8SJulian Andres Klode BUG_ON(nvec->rx == NULL); 5930cab4cb8SJulian Andres Klode nvec->rx->data[1] = received; 5940cab4cb8SJulian Andres Klode nvec->rx->pos = 2; 5950cab4cb8SJulian Andres Klode nvec->state = 4; 59632890b98SMarc Dietrich } else { 5970cab4cb8SJulian Andres Klode nvec_invalid_flags(nvec, status, true); 59832890b98SMarc Dietrich } 5990cab4cb8SJulian Andres Klode break; 6000cab4cb8SJulian Andres Klode case 3: /* EC does a block read, we transmit data */ 6010cab4cb8SJulian Andres Klode if (status & END_TRANS) { 6020cab4cb8SJulian Andres Klode nvec_tx_completed(nvec); 6030cab4cb8SJulian Andres Klode } else if ((status & RNW) == 0 || (status & RCVD)) { 6040cab4cb8SJulian Andres Klode nvec_invalid_flags(nvec, status, true); 6050cab4cb8SJulian Andres Klode } else if (nvec->tx && nvec->tx->pos < nvec->tx->size) { 6060cab4cb8SJulian Andres Klode to_send = nvec->tx->data[nvec->tx->pos++]; 60732890b98SMarc Dietrich } else { 6080cab4cb8SJulian Andres Klode dev_err(nvec->dev, "tx buffer underflow on %p (%u > %u)\n", 6090cab4cb8SJulian Andres Klode nvec->tx, 6100cab4cb8SJulian Andres Klode (uint) (nvec->tx ? nvec->tx->pos : 0), 6110cab4cb8SJulian Andres Klode (uint) (nvec->tx ? nvec->tx->size : 0)); 6120cab4cb8SJulian Andres Klode nvec->state = 0; 6130cab4cb8SJulian Andres Klode } 6140cab4cb8SJulian Andres Klode break; 6150cab4cb8SJulian Andres Klode case 4: /* EC does some write, we read the data */ 6160cab4cb8SJulian Andres Klode if ((status & (END_TRANS | RNW)) == END_TRANS) 6170cab4cb8SJulian Andres Klode nvec_rx_completed(nvec); 6180cab4cb8SJulian Andres Klode else if (status & (RNW | RCVD)) 6190cab4cb8SJulian Andres Klode nvec_invalid_flags(nvec, status, true); 6200cab4cb8SJulian Andres Klode else if (nvec->rx && nvec->rx->pos < NVEC_MSG_SIZE) 6210cab4cb8SJulian Andres Klode nvec->rx->data[nvec->rx->pos++] = received; 6220cab4cb8SJulian Andres Klode else 6230cab4cb8SJulian Andres Klode dev_err(nvec->dev, 6240cab4cb8SJulian Andres Klode "RX buffer overflow on %p: " 6250cab4cb8SJulian Andres Klode "Trying to write byte %u of %u\n", 6260cab4cb8SJulian Andres Klode nvec->rx, nvec->rx->pos, NVEC_MSG_SIZE); 6270cab4cb8SJulian Andres Klode break; 6280cab4cb8SJulian Andres Klode default: 6290cab4cb8SJulian Andres Klode nvec->state = 0; 63032890b98SMarc Dietrich } 63132890b98SMarc Dietrich 6320cab4cb8SJulian Andres Klode /* If we are told that a new transfer starts, verify it */ 6330cab4cb8SJulian Andres Klode if ((status & (RCVD | RNW)) == RCVD) { 6340cab4cb8SJulian Andres Klode if (received != nvec->i2c_addr) 6350cab4cb8SJulian Andres Klode dev_err(nvec->dev, 6360cab4cb8SJulian Andres Klode "received address 0x%02x, expected 0x%02x\n", 6370cab4cb8SJulian Andres Klode received, nvec->i2c_addr); 6380cab4cb8SJulian Andres Klode nvec->state = 1; 63932890b98SMarc Dietrich } 6400cab4cb8SJulian Andres Klode 6410cab4cb8SJulian Andres Klode /* Send data if requested, but not on end of transmission */ 6420cab4cb8SJulian Andres Klode if ((status & (RNW | END_TRANS)) == RNW) 6430cab4cb8SJulian Andres Klode writel(to_send, nvec->base + I2C_SL_RCVD); 6440cab4cb8SJulian Andres Klode 6450cab4cb8SJulian Andres Klode /* If we have send the first byte */ 6460cab4cb8SJulian Andres Klode if (status == (I2C_SL_IRQ | RNW | RCVD)) 6470cab4cb8SJulian Andres Klode nvec_gpio_set_value(nvec, 1); 6480cab4cb8SJulian Andres Klode 6490cab4cb8SJulian Andres Klode dev_dbg(nvec->dev, 6500cab4cb8SJulian Andres Klode "Handled: %s 0x%02x, %s 0x%02x in state %u [%s%s%s]\n", 6510cab4cb8SJulian Andres Klode (status & RNW) == 0 ? "received" : "R=", 6520cab4cb8SJulian Andres Klode received, 6530cab4cb8SJulian Andres Klode (status & (RNW | END_TRANS)) ? "sent" : "S=", 6540cab4cb8SJulian Andres Klode to_send, 6550cab4cb8SJulian Andres Klode state, 6560cab4cb8SJulian Andres Klode status & END_TRANS ? " END_TRANS" : "", 6570cab4cb8SJulian Andres Klode status & RCVD ? " RCVD" : "", 6580cab4cb8SJulian Andres Klode status & RNW ? " RNW" : ""); 6590cab4cb8SJulian Andres Klode 660de839b8fSJulian Andres Klode 661de839b8fSJulian Andres Klode /* 662de839b8fSJulian Andres Klode * TODO: A correct fix needs to be found for this. 663de839b8fSJulian Andres Klode * 664de839b8fSJulian Andres Klode * We experience less incomplete messages with this delay than without 665de839b8fSJulian Andres Klode * it, but we don't know why. Help is appreciated. 666de839b8fSJulian Andres Klode */ 667de839b8fSJulian Andres Klode udelay(100); 668de839b8fSJulian Andres Klode 66932890b98SMarc Dietrich return IRQ_HANDLED; 67032890b98SMarc Dietrich } 67132890b98SMarc Dietrich 672f686e9afSMarc Dietrich static void tegra_init_i2c_slave(struct nvec_chip *nvec) 67332890b98SMarc Dietrich { 67432890b98SMarc Dietrich u32 val; 67532890b98SMarc Dietrich 676f686e9afSMarc Dietrich clk_enable(nvec->i2c_clk); 677f686e9afSMarc Dietrich 678f686e9afSMarc Dietrich tegra_periph_reset_assert(nvec->i2c_clk); 67932890b98SMarc Dietrich udelay(2); 680f686e9afSMarc Dietrich tegra_periph_reset_deassert(nvec->i2c_clk); 68132890b98SMarc Dietrich 68232890b98SMarc Dietrich val = I2C_CNFG_NEW_MASTER_SFM | I2C_CNFG_PACKET_MODE_EN | 68332890b98SMarc Dietrich (0x2 << I2C_CNFG_DEBOUNCE_CNT_SHIFT); 684f686e9afSMarc Dietrich writel(val, nvec->base + I2C_CNFG); 68532890b98SMarc Dietrich 686ac810759SMarc Dietrich clk_set_rate(nvec->i2c_clk, 8 * 80000); 687ac810759SMarc Dietrich 688ac810759SMarc Dietrich writel(I2C_SL_NEWL, nvec->base + I2C_SL_CNFG); 689ac810759SMarc Dietrich writel(0x1E, nvec->base + I2C_SL_DELAY_COUNT); 690ac810759SMarc Dietrich 691ac810759SMarc Dietrich writel(nvec->i2c_addr>>1, nvec->base + I2C_SL_ADDR1); 692ac810759SMarc Dietrich writel(0, nvec->base + I2C_SL_ADDR2); 693ac810759SMarc Dietrich 694ac810759SMarc Dietrich enable_irq(nvec->irq); 695ac810759SMarc Dietrich 696ac810759SMarc Dietrich clk_disable(nvec->i2c_clk); 697ac810759SMarc Dietrich } 698ac810759SMarc Dietrich 699ac810759SMarc Dietrich static void nvec_disable_i2c_slave(struct nvec_chip *nvec) 700ac810759SMarc Dietrich { 701ac810759SMarc Dietrich disable_irq(nvec->irq); 702ac810759SMarc Dietrich writel(I2C_SL_NEWL | I2C_SL_NACK, nvec->base + I2C_SL_CNFG); 703f686e9afSMarc Dietrich clk_disable(nvec->i2c_clk); 70432890b98SMarc Dietrich } 70532890b98SMarc Dietrich 70632890b98SMarc Dietrich static void nvec_power_off(void) 70732890b98SMarc Dietrich { 70832890b98SMarc Dietrich nvec_write_async(nvec_power_handle, EC_DISABLE_EVENT_REPORTING, 3); 70932890b98SMarc Dietrich nvec_write_async(nvec_power_handle, "\x04\x01", 2); 71032890b98SMarc Dietrich } 71132890b98SMarc Dietrich 71232890b98SMarc Dietrich static int __devinit tegra_nvec_probe(struct platform_device *pdev) 71332890b98SMarc Dietrich { 714f686e9afSMarc Dietrich int err, ret; 71532890b98SMarc Dietrich struct clk *i2c_clk; 71632890b98SMarc Dietrich struct nvec_platform_data *pdata = pdev->dev.platform_data; 71732890b98SMarc Dietrich struct nvec_chip *nvec; 71832890b98SMarc Dietrich struct nvec_msg *msg; 719f686e9afSMarc Dietrich struct resource *res; 720f686e9afSMarc Dietrich struct resource *iomem; 721f686e9afSMarc Dietrich void __iomem *base; 72232890b98SMarc Dietrich 72332890b98SMarc Dietrich nvec = kzalloc(sizeof(struct nvec_chip), GFP_KERNEL); 72432890b98SMarc Dietrich if (nvec == NULL) { 72532890b98SMarc Dietrich dev_err(&pdev->dev, "failed to reserve memory\n"); 72632890b98SMarc Dietrich return -ENOMEM; 72732890b98SMarc Dietrich } 72832890b98SMarc Dietrich platform_set_drvdata(pdev, nvec); 72932890b98SMarc Dietrich nvec->dev = &pdev->dev; 73032890b98SMarc Dietrich nvec->gpio = pdata->gpio; 731f686e9afSMarc Dietrich nvec->i2c_addr = pdata->i2c_addr; 73232890b98SMarc Dietrich 733f686e9afSMarc Dietrich res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 734f686e9afSMarc Dietrich if (!res) { 735f686e9afSMarc Dietrich dev_err(&pdev->dev, "no mem resource?\n"); 736f686e9afSMarc Dietrich return -ENODEV; 73732890b98SMarc Dietrich } 73832890b98SMarc Dietrich 739f686e9afSMarc Dietrich iomem = request_mem_region(res->start, resource_size(res), pdev->name); 740f686e9afSMarc Dietrich if (!iomem) { 741f686e9afSMarc Dietrich dev_err(&pdev->dev, "I2C region already claimed\n"); 742f686e9afSMarc Dietrich return -EBUSY; 74332890b98SMarc Dietrich } 74432890b98SMarc Dietrich 745f686e9afSMarc Dietrich base = ioremap(iomem->start, resource_size(iomem)); 746f686e9afSMarc Dietrich if (!base) { 747f686e9afSMarc Dietrich dev_err(&pdev->dev, "Can't ioremap I2C region\n"); 748f686e9afSMarc Dietrich return -ENOMEM; 749f686e9afSMarc Dietrich } 75032890b98SMarc Dietrich 751f686e9afSMarc Dietrich res = platform_get_resource(pdev, IORESOURCE_IRQ, 0); 752f686e9afSMarc Dietrich if (!res) { 753f686e9afSMarc Dietrich dev_err(&pdev->dev, "no irq resource?\n"); 754f686e9afSMarc Dietrich ret = -ENODEV; 755f686e9afSMarc Dietrich goto err_iounmap; 756f686e9afSMarc Dietrich } 757f686e9afSMarc Dietrich 758f686e9afSMarc Dietrich i2c_clk = clk_get_sys("tegra-i2c.2", NULL); 759f686e9afSMarc Dietrich if (IS_ERR(i2c_clk)) { 760f686e9afSMarc Dietrich dev_err(nvec->dev, "failed to get controller clock\n"); 761f686e9afSMarc Dietrich goto err_iounmap; 76232890b98SMarc Dietrich } 76332890b98SMarc Dietrich 764f686e9afSMarc Dietrich nvec->base = base; 765f686e9afSMarc Dietrich nvec->irq = res->start; 766f686e9afSMarc Dietrich nvec->i2c_clk = i2c_clk; 7670cab4cb8SJulian Andres Klode nvec->rx = &nvec->msg_pool[0]; 768f686e9afSMarc Dietrich 76932890b98SMarc Dietrich /* Set the gpio to low when we've got something to say */ 77032890b98SMarc Dietrich err = gpio_request(nvec->gpio, "nvec gpio"); 77132890b98SMarc Dietrich if (err < 0) 77232890b98SMarc Dietrich dev_err(nvec->dev, "couldn't request gpio\n"); 77332890b98SMarc Dietrich 77432890b98SMarc Dietrich ATOMIC_INIT_NOTIFIER_HEAD(&nvec->notifier_list); 77532890b98SMarc Dietrich 77632890b98SMarc Dietrich init_completion(&nvec->sync_write); 7770cab4cb8SJulian Andres Klode init_completion(&nvec->ec_transfer); 7780cab4cb8SJulian Andres Klode mutex_init(&nvec->sync_write_mutex); 7790cab4cb8SJulian Andres Klode spin_lock_init(&nvec->tx_lock); 7800cab4cb8SJulian Andres Klode spin_lock_init(&nvec->rx_lock); 78132890b98SMarc Dietrich INIT_LIST_HEAD(&nvec->rx_data); 7820cab4cb8SJulian Andres Klode INIT_LIST_HEAD(&nvec->tx_data); 78332890b98SMarc Dietrich INIT_WORK(&nvec->rx_work, nvec_dispatch); 78432890b98SMarc Dietrich INIT_WORK(&nvec->tx_work, nvec_request_master); 7850cab4cb8SJulian Andres Klode nvec->wq = alloc_workqueue("nvec", WQ_NON_REENTRANT, 2); 78632890b98SMarc Dietrich 787f686e9afSMarc Dietrich err = request_irq(nvec->irq, nvec_interrupt, 0, "nvec", nvec); 788f686e9afSMarc Dietrich if (err) { 789f686e9afSMarc Dietrich dev_err(nvec->dev, "couldn't request irq\n"); 790f686e9afSMarc Dietrich goto failed; 791f686e9afSMarc Dietrich } 792ac810759SMarc Dietrich disable_irq(nvec->irq); 793f686e9afSMarc Dietrich 794f686e9afSMarc Dietrich tegra_init_i2c_slave(nvec); 795f686e9afSMarc Dietrich 796ac810759SMarc Dietrich clk_enable(i2c_clk); 797ac810759SMarc Dietrich 798f686e9afSMarc Dietrich gpio_direction_output(nvec->gpio, 1); 799f686e9afSMarc Dietrich gpio_set_value(nvec->gpio, 1); 800f686e9afSMarc Dietrich 80132890b98SMarc Dietrich /* enable event reporting */ 80232890b98SMarc Dietrich nvec_write_async(nvec, EC_ENABLE_EVENT_REPORTING, 80332890b98SMarc Dietrich sizeof(EC_ENABLE_EVENT_REPORTING)); 80432890b98SMarc Dietrich 80532890b98SMarc Dietrich nvec->nvec_status_notifier.notifier_call = nvec_status_notifier; 80632890b98SMarc Dietrich nvec_register_notifier(nvec, &nvec->nvec_status_notifier, 0); 80732890b98SMarc Dietrich 80832890b98SMarc Dietrich nvec_power_handle = nvec; 80932890b98SMarc Dietrich pm_power_off = nvec_power_off; 81032890b98SMarc Dietrich 81132890b98SMarc Dietrich /* Get Firmware Version */ 81232890b98SMarc Dietrich msg = nvec_write_sync(nvec, EC_GET_FIRMWARE_VERSION, 81332890b98SMarc Dietrich sizeof(EC_GET_FIRMWARE_VERSION)); 81432890b98SMarc Dietrich 8150cab4cb8SJulian Andres Klode if (msg) { 81632890b98SMarc Dietrich dev_warn(nvec->dev, "ec firmware version %02x.%02x.%02x / %02x\n", 81732890b98SMarc Dietrich msg->data[4], msg->data[5], msg->data[6], msg->data[7]); 81832890b98SMarc Dietrich 8190cab4cb8SJulian Andres Klode nvec_msg_free(nvec, msg); 8200cab4cb8SJulian Andres Klode } 82132890b98SMarc Dietrich 822f686e9afSMarc Dietrich ret = mfd_add_devices(nvec->dev, -1, nvec_devices, 823f686e9afSMarc Dietrich ARRAY_SIZE(nvec_devices), base, 0); 824f686e9afSMarc Dietrich if (ret) 825f686e9afSMarc Dietrich dev_err(nvec->dev, "error adding subdevices\n"); 826f686e9afSMarc Dietrich 82732890b98SMarc Dietrich /* unmute speakers? */ 8286dca320cSMarc Dietrich nvec_write_async(nvec, "\x0d\x10\x59\x95", 4); 82932890b98SMarc Dietrich 83032890b98SMarc Dietrich /* enable lid switch event */ 83132890b98SMarc Dietrich nvec_write_async(nvec, "\x01\x01\x01\x00\x00\x02\x00", 7); 83232890b98SMarc Dietrich 83332890b98SMarc Dietrich /* enable power button event */ 83432890b98SMarc Dietrich nvec_write_async(nvec, "\x01\x01\x01\x00\x00\x80\x00", 7); 83532890b98SMarc Dietrich 83632890b98SMarc Dietrich return 0; 83732890b98SMarc Dietrich 838f686e9afSMarc Dietrich err_iounmap: 839f686e9afSMarc Dietrich iounmap(base); 84032890b98SMarc Dietrich failed: 84132890b98SMarc Dietrich kfree(nvec); 84232890b98SMarc Dietrich return -ENOMEM; 84332890b98SMarc Dietrich } 84432890b98SMarc Dietrich 84532890b98SMarc Dietrich static int __devexit tegra_nvec_remove(struct platform_device *pdev) 84632890b98SMarc Dietrich { 847f686e9afSMarc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 848f686e9afSMarc Dietrich 849f686e9afSMarc Dietrich nvec_write_async(nvec, EC_DISABLE_EVENT_REPORTING, 3); 850f686e9afSMarc Dietrich mfd_remove_devices(nvec->dev); 851f686e9afSMarc Dietrich free_irq(nvec->irq, &nvec_interrupt); 852f686e9afSMarc Dietrich iounmap(nvec->base); 853f686e9afSMarc Dietrich gpio_free(nvec->gpio); 8540cab4cb8SJulian Andres Klode destroy_workqueue(nvec->wq); 855f686e9afSMarc Dietrich kfree(nvec); 856f686e9afSMarc Dietrich 85732890b98SMarc Dietrich return 0; 85832890b98SMarc Dietrich } 85932890b98SMarc Dietrich 86032890b98SMarc Dietrich #ifdef CONFIG_PM 86132890b98SMarc Dietrich 86232890b98SMarc Dietrich static int tegra_nvec_suspend(struct platform_device *pdev, pm_message_t state) 86332890b98SMarc Dietrich { 86432890b98SMarc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 8659feeb014SMarc Dietrich struct nvec_msg *msg; 86632890b98SMarc Dietrich 86732890b98SMarc Dietrich dev_dbg(nvec->dev, "suspending\n"); 8689feeb014SMarc Dietrich 8699feeb014SMarc Dietrich /* keep these sync or you'll break suspend */ 8709feeb014SMarc Dietrich msg = nvec_write_sync(nvec, EC_DISABLE_EVENT_REPORTING, 3); 8719feeb014SMarc Dietrich nvec_msg_free(nvec, msg); 8729feeb014SMarc Dietrich msg = nvec_write_sync(nvec, "\x04\x02", 2); 8739feeb014SMarc Dietrich nvec_msg_free(nvec, msg); 8749feeb014SMarc Dietrich 875ac810759SMarc Dietrich nvec_disable_i2c_slave(nvec); 87632890b98SMarc Dietrich 87732890b98SMarc Dietrich return 0; 87832890b98SMarc Dietrich } 87932890b98SMarc Dietrich 880162c7d8cSMarc Dietrich static int tegra_nvec_resume(struct platform_device *pdev) 881162c7d8cSMarc Dietrich { 88232890b98SMarc Dietrich struct nvec_chip *nvec = platform_get_drvdata(pdev); 88332890b98SMarc Dietrich 88432890b98SMarc Dietrich dev_dbg(nvec->dev, "resuming\n"); 885f686e9afSMarc Dietrich tegra_init_i2c_slave(nvec); 88632890b98SMarc Dietrich nvec_write_async(nvec, EC_ENABLE_EVENT_REPORTING, 3); 88732890b98SMarc Dietrich 88832890b98SMarc Dietrich return 0; 88932890b98SMarc Dietrich } 89032890b98SMarc Dietrich 89132890b98SMarc Dietrich #else 89232890b98SMarc Dietrich #define tegra_nvec_suspend NULL 89332890b98SMarc Dietrich #define tegra_nvec_resume NULL 89432890b98SMarc Dietrich #endif 89532890b98SMarc Dietrich 896162c7d8cSMarc Dietrich static struct platform_driver nvec_device_driver = { 89732890b98SMarc Dietrich .probe = tegra_nvec_probe, 89832890b98SMarc Dietrich .remove = __devexit_p(tegra_nvec_remove), 89932890b98SMarc Dietrich .suspend = tegra_nvec_suspend, 90032890b98SMarc Dietrich .resume = tegra_nvec_resume, 90132890b98SMarc Dietrich .driver = { 90232890b98SMarc Dietrich .name = "nvec", 90332890b98SMarc Dietrich .owner = THIS_MODULE, 90432890b98SMarc Dietrich } 90532890b98SMarc Dietrich }; 90632890b98SMarc Dietrich 90732890b98SMarc Dietrich static int __init tegra_nvec_init(void) 90832890b98SMarc Dietrich { 90932890b98SMarc Dietrich return platform_driver_register(&nvec_device_driver); 91032890b98SMarc Dietrich } 91132890b98SMarc Dietrich 91232890b98SMarc Dietrich module_init(tegra_nvec_init); 913162c7d8cSMarc Dietrich 91432890b98SMarc Dietrich MODULE_ALIAS("platform:nvec"); 915162c7d8cSMarc Dietrich MODULE_DESCRIPTION("NVIDIA compliant embedded controller interface"); 916162c7d8cSMarc Dietrich MODULE_AUTHOR("Marc Dietrich <marvin24@gmx.de>"); 917162c7d8cSMarc Dietrich MODULE_LICENSE("GPL"); 918